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(54) CONTROLLER OF LEGGED MOBILE ROBOT 

(57) a control device for a legged mobile robot in 
which a correction manipulated variable of a desired 
floor reaction force (desired floor reaction force's mo- 
ment) is subsequently determined based on an error be- 
tween an actual state quantity, such as a body posture 
angle, of the robot 1 and a desired state quantity of the 
same, and at the same time, a desired movement of the 
robot 1 is subsequently determined by the use of the 
correction manipulated variable and a dynamic model • 
At this time, a friction force component, which defines a 
f notional force between the robot 1 and a floor such as 
a translation floor reaction force's horizontal compo- 
nent, is set as a variable to be limited, and an allowable 
range of the variable to be limited is set. The desired 
movement is determined so that the variable to be lim- 
ited remains within the allowable range and a resultant 
force of an inertia! force and gravity, generated. by the 
movement of the robot 1 on the dynamic model, balanc- 
es with a floor reaction force obtained by correcting the 
desired floor reaction force by the correction manipulat- 
ed variable. The desired movement is determined by ad- 
justing a plurality of movement modes having mutually 
different generation ratios of a floor reaction force's mo- 
ment and a translation floor reaction force 
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[0001] The present invention relates to a control device for a legged mobile robot and more specifically to a control 
device for a legged mobile robot, provided with an interna! model generating a desired gait of the robot, causing behavior 
of the robot (actual robot) to follow behavior of the internal model. 



BACKGROUND ART 



[0002] Known as a legged mobile robot, particularly as a legged mobile robot with two legs, is a robot described in, 
for example, Japanese Patent Laid-Open Publication No. Showa 62-97005 and Japanese Patent Laid-Open Publica- 
tion No. Showa 63-150176. Control of robots including the legged mobile robot is detailed in, for example, Robotics 
Handbook, Robotic Society of Japan, Oct. 20, 1 990. 
15 [0003] The stability of the legged mobile robot, particularly the legged mobile robot with two legs, is intrinsically low. 
Therefore when disturbance or the like is applied to the robot, the posture of the robot becomes unstable. Thus, it is 
preferred that an inclination angle (posture angle) of the body of the robot and the rate of change of the angle are 
detected and the posture. of the robot is then controlled in accordance with the detected values. To do so, control was 
earlier proposed by the applicant in Japanese Patent Laid-Open Publication No. Heisei 4-201187 and the like. In this 
20 • control, a plurality of candidate landing positions are prepared in advance, and any one of those candidate landing 
positions is selected in a control cycle of each step and then a desired gait is switched. 

[0004] However, in this control, even when posture is disrupted, there occurs no effect of recovering the posture until 
the next landing. Therefore, the posture may be largely disrupted before the next landing and the robot may fall over. 
In addition, this control has the following disadvantage. Even though floor contactability is diminished, as a result of 

25 disruption of the posture which causes the ZMP (the center of gravity where vertical floor reaction force acts and a 
horizontal component of a floor reaction force's moment becomes zero; zero moment point) to shift close to the vicinity 
of the boundary of a range where the ZMP can exist, the ZMP remains shifted to the vicinity of the boundary until the 
posture is recovered by correcting the gait in the next step. Thus, contact with the ground cannot be recovered- until then. 
[0005] Thus, the applicant has proposed the following technology in, for example, Japanese Patent Laid-Open Pub- 

so lication No. Heisei 5-305579. In this technology, a desired gait is generated, in which a floor reaction force is set to 
ensure a state of dynamic equilibrium, based on a dynamic model of a robot. When errors occur between the desired 
and actual values of the inclination angles and inclination angular velocities due to a modeling error or disturbance, 
displacement or a moment of the floor contacting portion of the actual robot is deliberately shifted from that of a reference 
gait. Accordingly, the floor reaction force of the actual robot (actual floor reaction force) is deliberately shifted from the 

35 floor reaction force of the desired gait which is calculated by the model, thus obtaining a recovering force which brings 
inclination of the actual robot near inclination of the model.-Note that,the"floor reaction force 1 ' herein means a resultant 
force and resultant moment acting at a certain point of action, obtained as the sum of all floor reaction forces acting 
on respective legs. 

[0006] However, when this technology is used, during a one-leg supporting period of a biped mobile robot, for ex- 
40 ample, it is sometimes infeasible to generate the total floor reaction force with the ZMP outside of the contact surface, 
even though the ankle joint angle is largely shifted to deliberately and greatly shift the floor reaction force of actual 
robot. Therefore, a part of the foot rises off the floor. Hence, when the actual robot greatly inclines relative to the model, 
it is sometimes impossible to obtain the sufficient recovering force for bringing inclination of actual robot back to normal. 
In this case, the actual robot falls over. In other words, with the technology proposed in Japanese Patent Laid-Open 
45 Publication No. Heisei 5-305579, the recovering effect reducing the errors between the desired values and actual 
values is limited within the range where the ZMP can exist. 

[0007] The above technologies are explained with reference to the drawings. As for the control which causes joint 
displacement of the actual robot to strictly follow the model, the ZMP of the actual robot shown by a solid line in Fig. 
61 coincides with the desired ZM P determined by the model, if the inclination angle and inclination angular velocity of 

so the actual robot coincide with those of the model. Thus, the robot walks with a desired posture, in reality, however, the 
errors in the inclination angles and inclination angular velocities occur as shown by a dotted line, due to a modeling 
error or disturbance as mentioned earlier. In addition, the gravitational effect causes these shifts to have a tendency 
toward divergence in which the shifts increase more as the errors increase in magnitude. Once the actual ZMP shifts 
from the desired ZMP, a moment M obtained by multiplying a distance x between the actual and desired ZMPs by a 

55 force F is generated about the desired ZMP, as shown in Fig. 62. In other words, a desired moment can be generated 
by controlling joint displacement to deliberately shift the actual ZMP from the desired ZMP. Based on this idea, the 
earlier proposed technology generates a moment in a direction for posture recovery by deliberately shifting the actual 
ZMP as shown in Fig. 62 when the errors in inclination (angle and angular velocity) occur When this technology is 



2 



EP 1 475 198 A1 



10 



15 



20 



25 



30 



35 



40 



45 



50 



55 



posture recovery of the roboTm^ not be pursued apptpriat^. ^ ° f ^ '* ^ ^ thus the 

[0008] Thus, the applicant of the application concerned has also proposed the follower, t^h„ , • , 
Patent Laid-open Publication No. Heisei 5-337849 or the like SoeclSfv Mr fth ItS , 9 teChno10 ^ ln Ja Panese 
nation of the robot occur, the actual ZMP is shifted a ^ esc bed above ge e a ItSTT^ ' nC "' 
recovery about the desired ZMP within allowable rannp «nri »» .hi l °. generale a m °ment in the direction of posture 
so as to generate a moment abou the desS ZM on the m J2 ^ m ° Vement ° f 3 deSired gait is determined 
generating the moment on the mode^ above ^^SS^t^T" 0 ?" ^ By intenti ° naNy 

of posture recovery on the actual robot can be obtled I "^^T^J^^^Z^!"^ 
moment on the model without considering the range in which he ZMP cln oxL Thtl° T 
generate the moment in the direction of posture recovery on tho «tf .7*1 ^ T T ^? r& ' even lf ,l 13 difflcult to 

set i e z s n of , the r ai robot £ be moment on the modei 

nont orM , °' \ ne r0D0TS Doc| y (eventually, by adjusting a translation floor reaction force's hon>nnt*i 

reaction fe re e becomes verv erea,, <a Mctta* .oro^hch ear, be e,t^ X^^t lT 



DISCLOSURE OF THE INVENTION 



and a floor reaction force of the rohnt a t +h JL^ *• r «presenung at least a relation between a movement 

error between a desired state quantity of a Dostum of tho m h«t ,.!k k movement based on at least an 

value of the desired movement* acCatSe ^oJlSSl C ° rreSp ° nds to the determined instantaneous 

center-of-gravSy aoce.eration o^^^S^^^S^ hTtlT f i^T' * ** *** 

robot is in proportional or almost proportional to J Son toZ Th! J ! center-of-gravrty acceleration of the 
referred to as a friction force oo^Z^ollt^ " deSCnPti ° n be,OW <. ^ ™ generally 

^o„i^^iT^«^;:r r an r ous vaiue of the desired m — * - 

posture of the robot- so that the vahabS to fe |S2^ 1 f 6 r ° b0t and thS SCtUal State « uantit y of the 
beceraes sraal, (for examp^Sng S ° ' 0a, C ° mf "™ n, ,he ,ran8la,i0n '"*» «»*" «"~ 
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means determine the new instantaneous value of the desired movement by adjusting a plurality of the movement 
modes of the movement of the dynamic model, in accordance with the allowable range (second aspect of the i nvention) . 
[0015] According to the second aspect of this invention, it becomes possible to determine the desired movement of 
the robot by adjusting the plurality of movement modes so that the floor reaction force's moment and the translation 

5 floor reaction force become arbitral desired values, respectively. Therefore, by adjusting the plurality of movement 
modes in accordance with al least the allowable range of Lhe variable to be limited while considering the allowable 
range of the variable to be limited, the friction force componenl (which depends on the translation floor reaction force), 
serving as the variable to be limited, remains within the allowable range, and it becomes possible to determine the 
instantaneous value of the desired movement which can generate a floor reaction force's moment which causes the 

10 error to be close to zero. For example, in a situation where the floor reaction force's moment in a direction in which the 
error becomes close to zero, is generated in one of the movement modes, if the friction force component seems about 
to exceed the allowable range, the desired floor reaction force's moment can be maintained and the friction force 
component can be caused to remain within the allowable range, by adjusting the one of the movement mode and the 
other movement modes. 

15 [0016] Further, in the second aspect of this invention, it is preferred that the movement modes include a posture 
changing movement for changing a posture of a predetermined portion of the robot (for example, the body of the robot) 
while maintaining center-of-gravity of the robot almost invariable, and a translation movement of the body of the robot 
(third aspect of the invention). 

[0017] According to this, the translation floor reaction force can be mainly adjusted by a translation movement of the 
20 body and the floor reaction force's moment can be adjusted by the posture changing movement without changing the 
translation floor reaction force so much. Thus, it becomes possible to easily perform determination processing of the 
instantaneous value of the desired movement which can generate the desired floor reaction force's moment and desired 
translation floor reaction force (thus, desired friction force component). 

[0018] Moreover, in the first to third aspects of this invention, it is preferred that the control device for a legged mobile 
25 robot comprise means for correcting gait parameters for determining a pattern(s) of a desired floor reaction force and/ 
or a desired movement of the robot after current time, in accordance with at least a state quantity of the dynamic model 

(fourth aspect of the invention). • . 

[0019] According to this, the gait parameters (for exampie 1 parameters defining a trajectory of a desired ZMP (desired 
floor reaction force central point) and the like) defining basic patterns (forms) of the desired floor reaction force and 
30 desired movement of the robot are corrected in accordance with the state quantity of the dynamic model. Thus, it 
becomes possible to determine the desired floor reaction force and desired movement while maintaining continuous 
stability -of behavior of the dynamic model. 

[0020] Moreover, in the first aspect of this invention, it is preferred that the control device for a legged mobile robot 
comprise means for successively determining a reference instantaneous value of a desired floor reaction force of the 
35 robot, and that the desired instantaneous value determining means determine a correction manipulated variable of the 
desired floor reaction force in accordance with at least the error and the allowable range of the variable to be limited, 
and also determine the new instantaneous value of the desired movement to permit a resultant force of an inertial force 
and gravity, generated on the dynamic model by the new instantaneous value of the desired movement, to balance 
with a floor reaction force obtained by correcting the reference instantaneous value by the correction manipulated 

40 variable (fifth aspect of the invention), 

[0021] According to this, the correction manipulated variable of the desired floor reaction force is used as an element 
for manipulating the error and variable to be limited. In addition, the desired floor reaction force is a physical quantity 
which directly and particularly affects the friction force component serving as the variable to be limited. Therefore it 
becomes possible to relatively easily determine a preferable correction manipulated variable which enables the error 

45 to be close to zero, while causing the friction force component serving as the variable to be limited, to remain within 
the allowable range. As a result, it becomes possible to determine the new instantaneous value of a preferable desired 
movement for causing the error to be close to zero, while causing the friction force component to remain within the 
allowable range and reducing a calculation load. 

[0022] In the fifth aspect of this invention, it is preferred to employ a mode similar to those of the second and third 
so aspects of this invention. In other words, it is preferred that a movement of the dynamic model include at least a plurality 
of movement modes of the robot, the movement modes having mutually different generation ratios of a floor reaction 
force's moment to the translation floor reaction force, and that the desired instantaneous value determining means 
determine the new instantaneous value of the desired movement by adjusting a plurality of the movement modes of 
the movement of the dynamic model, in accordance with at least the allowable range (sixth aspect of the invention). 
55 Furthermore, in the sixth aspect of this invention, it is preferred that the movement modes include a posture changing 
movement for changing a posture of a predetermined portion of the robot while maintaining center- of -gravity of the 
robot almost invariable, and a translation movement of the body of the robot (seventh aspect of the invention). 
[0023] According to the sixth and seventh aspects of this invention, operational advantages similar to those of the 
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second and third aspects of this invention can be achieved, respectively 

[0024] In addition, in the seventh aspect of this invention, it is preferred that the desired instantaneous value deter- 
mining means determine a new desired instantaneous value of the desired movement by preferen ZZ adtstin he 
translation movement of the body, rather than the posture changing movement, in order t ^eSSeZSone 
to balance with the floor reaction force obtained by correcting the reference instantaneous va7ue by the co»n 
man.pulated variable of the desired floor reaction force (eighth aspect of the invention) correction 
[0025] In other words, a posture changing movement about the center of gravity of the robot such as the posture 
changing movement of the body, easily causes a large fluctuation of the posture of the robot whic change tnTf oor 
reaction force's moment On the other hand, ohanges of the translation floor reaction fo^^ZS^Z 
moment has relatively h,gh sensitivity to the changes of the translation movement of the body. Therefore bj Prefer" 
the m n^" fZ T * ^ ° f the ^ * the roboLa b" P p eTe To 



[0026] Further, m the fifth to eights aspects of this invention, it is preferred that the control device fora legged mobile 
comprise means for determining the correction manipulated variable of the desired floor reaction force in accordance 
wrth a least the error, the allowable range of the variable to be limited, and a state quantity of the dynamic mode (ninth 
aspect of the present invention). >"=uy>iamicmoaenninm 

[0027] According to this, not only the error (that is, the error of the state quantity of the posture of the actual robots 
but also the state quantity of the dynamic model are factored in the correction manipulated variable of the dts'ed S 
reaction force. Therefore, it becomes possible to ensure not only stability of the posture of the ££al robot but alo 
stability of behavior of the dynamic model. Accordingly, It becomes possible to determine a nstalnlous value of a 
desired movement preferable for actual stable movement of the robot iswnianeous value of a 

^ ^ th9t thS ^ qUantity ° f thS dynamic moclel mav include the center °f g^ity of the robot on the dvnamic 
model, body posture angle of the same, and their rates of change and the like dynamic 
[0029] Moreover, in the fifth to ninth aspects of this invention, it is preferred that the control device fora leqqed mobile 
robot comprise means for correcting gait parameters for determining a pattem(s) of the desired floor eaSon force 
and/or the desired movement of the robot after current time, in accordance with the correction m^SS^S 
of the desired floor reaction force used for determining an instantaneous value of the desired JSSSaS^ a 

StKT / T ° f thS dynami ° m0dd by the C0rrection manipulated variable (tenth aspTct oUhlvenZ) 

[0030] According to th,s, the gait parameters (for example, parameters defining a trajectory of a des red ZM ^desired 

' TjJe7ZVZ C : 77 77 " ke) d6finin9 baSiC PattSmS (f0miS) ° f the desi ^ d floor -Sfon force "d 

des red movement of the robot are corrected in accordance with the correction manipulated variable of the desired 

Thu/^T and = han9eS ° f the State < uantity of tne tannic model by the correction man^la ted v2 
Thus, it becomes possible to ensure continuous stability of behavior of the dynamic model 

[0031] Furthermore, in the fifth to tenth aspects of this invention, it is preferred that the control device for a leaned 
mobile robot comprise first means for determining a first required manipulated variable of a floor ^on l£?E 

ZT,7 e ^ 77 S ° tHat err ° r b6C0meS C,OSe t0 Zer ° : S6Cond means f °r detennln^Su^r 
reaction force manipulated variable and the correction manipulated variable of the desired floor reaction force whfch 
define a desired value of an actual floor reaction force of the robot, based on at least the first requimd maniputteo 
vanable; and third means for performing movement control of the robot in accordance with the atfual f loor eactn 
once manipulated variable and the instantaneous value of the desired movement (eleventh aap^^ln^SnT 
ln,n , f 7 Z ' additi ° n t0 mani P ulati °n °f a fl°or reaction force on the dynamic model by the correct on 
Z 777 f ,T 16 °? S deSir6df,O0r reaction forcs ' the actual floor reaction force on the actual robot i manipuSed 
by the actual floor reaction force manipulated variable. As a result, manipulation of a floor reaction force for caus no 
the error to be close to zero can be distributed to the actual robot and the dynamic model, thereby keeping changes 
of behavior of the actual robot and changes of behavior of the dynamic mode, at minimum. Accordingly behaviofof 
the actual robot can be even more stabilized. ,u '"9'y, oenavior or 

S, J; the eleV t enth f aspect of tnis invention . * is Preferred that any one of the first required manipulated variable 
he actual floor reaction force manipulated variable, and the correction manipulated variable of the desired floor reaction 
force is a manipulated variable related to a floor reaction force's moment about a point of action of a floor eac on 
force, a Pos .on o f the int of actjon of tne f|oor forcS| or & mp P t^e invention) n Zer 

Z7r \T ,' ty ° f P ° StUre ° f thS r ° b0t iS 9reat,y affected ^ the fl0 °r reaction force's moment about t e point 
zLp ° 7 f ' 00r reaCti ° n f ° rCe ' the P ° sition ° f tne P° int of action of the floor reaction force or the portion of the 
ZMP (point about which the horizontal component of the floor reaction force's moment is zero) Thus by sing the 
plated variables related to them as the first required manipulated variable, the actual floor eact on force manip 

T:7^T^"rZ~ manipulated variable of the desired f loor reaction force - stability of the — 

[0034] Moreover, In the eleventh or twelfth aspect of this invention, it is preferred that the second means determine 
the actual floor reaction force manipulated variable andthe correction manipulated variable of the des^edfloor Reaction 
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force so that a difference between the actual floor reaction force manipulated variable and the correction manipulated 
variable of the desired floor reaction force monotonously changes as the first required manipulated variable increases 
(thirteenth aspect of the present invention). 

[0035] According to this, it is possible to determine the actual floor reaction force manipulated variable and the ma- 
5 nipulated variable of the desired floor reaction force which can cause the error to be close to zero. Note that, in order 
for the difference between the actual floor reaction force manipulated variable and the correction manipulated variable 
of the desired floor reaction Torce to monotonously change as the Ural required manipulated variable increases, the 
actual floor reaction force manipulated variable and the correction manipulated variable of the desired floor reaction 
force are determined so that the difference almost coincides with or is in proportional to the first required manipulated 
10 variable. 

[0036] In the eleventh to thirteenth aspects of this invention, it is preferred that the second means determine the 
actual floor reaction force manipulated variable so that a value obtained by adding the actual floor reaction force ma- 
nipulated variable to the reference instantaneous value remains within a predetermined actual floor reaction force 
allowable range (fourteenth aspect of the invention). According to this, not only the friction force component (variable 
15 to be limited), but also the floor reaction force component corresponding to the actual floor reaction force manipulated 
variable, that is, the floor reaction force's moment about the point of action of the floor reaction force, the position of 
the point of action of the floor reaction force, and ZM P can remain within desirable allowable ranges. Therefore, stability 
of behavior of the robot can be even more improved. 

[0037] To be more specific, in the fourteenth aspect of this invention, when a value obtained by adding the first 

20 required manipulated variable to the reference instantaneous value is a value within the predetermined actual floor 
reaction force allowable range, the second means determines the first required manipulated variable as the actual floor 
reaction force manipulated variable, and determines the correction manipulated variable of the desired floor reaction 
force to be almost zero or a value defined in accordance with the state quantity of the dynamic model, and, when the 
value obtained by adding the first required manipulated variable to the reference instantaneous value deviates from 

25 the predetermined actual floor reaction force allowable range, the second means determines a value obtained by 
subtracting the reference instantaneous value from a limit vaiue of the actual floor reaction force allowable range, as 
the actual floor reaction force manipulated variable, and determines the correction manipulated variable of the desired . 
floor reaction force in accordance with at least a difference between the actual floor reaction force manipulated variable 
and the first required manipulated variable (fifteenth aspect of the invention). 

30 [0038] According to this, when a value obtained by adding a provisionally determined vaiue of the actual floor reaction 
force manipulated variable to the reference instantaneous value (a value equivalent to the actual floor reaction force 
of the robot; hereinafter referred to as an estimated value of actual floor reaction force) is within the actual floor reaction 
force allowable range, the actual floor reaction force of the actual robot is manipulated by the actual floor reaction force 
manipulated variable. Thus, the error is controlled to be close to zero. In addition, when the estimated value of actual 

35 floor reaction force deviates from the actual floor reaction force allowable range, an actual floor reaction force manip- 
ulated variable, which controls the estimated value of the above actual floor reaction force to remain within the actual 
floor reaction force allowable range, is determined. Therefore, when the actual floor reaction force of the robot is 
manipulated in accordance with the actual floor reaction force manipulated variable, the actual floor reaction force can 
remain within the predetermined actual floor reaction force allowable range. Further, when the estimated value of actual 

40 floor reaction force deviates from the actual floor reaction force allowable range, the actual floor reaction force manip- 
ulated variable is limited. However, the correction manipulated variable of the desired floor reaction force is determined 
in accordance with the difference between the actual floor reaction force manipulated variable and the first required 
manipulated variable, that is, a surplus of the first required manipulated variable for causing the error to be close to 
zero, which cannot be dealt by the actual floor reaction force manipulated variable. Thus, the error can be close to 

45 zero by the combination of manipulation of the actual floor reaction force in accordance with the actual floor reaction 
force manipulated variable, and manipulation of the floor reaction force on the dynamic model in accordance with the 
correction manipulated variable of the desired floor reaction force (adjustment of the instantaneous value of the desire 
movement). Note that, when the estimated value of actual floor reaction force is within the actual floor reaction force 
allowable range, behavior of the dynamic model can be stabilized when determining the correction manipulated variable 
so of the desired floor reaction force in accordance with the state quantity of the dynamic model. 

[0039] in the fourteenth aspect of this invention, the second means comprises: means for obtaining provisionally 
determined values of the actual floor reaction force manipulated variable and the correction manipulated variable of 
the desired floor reaction force so that a difference between the actual floor reaction force manipulated variable and 
the correction manipulated variable of the desired floor reaction force becomes at least a value corresponding to the 
55 first required manipulated variable; means for obtaining an estimated value of the variable to be limited corresponding 
to the new instantaneous value of the desired movement when the new instantaneous value of the desired movement 
is assumed to be determined by the use of the obtained provisionally determined value of the correction manipulated 
variable of the desired floor reaction force;' means for comparing a value obtained by adding the provisionally deter- 
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mated ItZ^Z^o Te Z£Z ZZXt 1 'T ^ '"^aneous value and the esti- 

a.iowab.e range of the vana £ \ ^ ^ IT^S^^^TT ^ ^ *" 
manipulated variable and the variable to be limited which satisfy by h actuTfloo ? ' l0 " ""f n toree 

and the allowable range of the variable to be limited, respectively based o a resu of th!-m^ ^ 
determining the correction manipulated variable of the desired flo^reacUon bt^onTZZ ^ TT* *" 
and a va.ue obtained by subtracfing the first required manipulafed JSiKh^S^Ji^S'n ^ 
force manipulated variable (sixteenth aspect of the invention) determined actual rioor reaction 

[0040] According to the sixteenth aspect of this invention, provisionally determined valu^nfth. ♦ ,„ 

force manipulated variable and the correction manipulated variable of he diTed ftoor rZu f "? reaCt '° n 

causes the error to Cose to -"p^ 

determined value of the ^^^S^^t^T^^ T° bV ^ the P™*"»n*Z 

after, referred to as provisional acZ,toT« **» ("-in- 

compared with the actual floor reaction force aiin«, a hi Q ra l T „ esri ™ted value of the variable to be limited are 
bver, Thus, a group o, me v^n^^^ZZ^^^TZT?? "a"?* ^ 

becomes possible to MemS "me »™S mln^T' 0 ^" 9e " erMed °" lh » "vnamio model. Thus, II 

^.'Lr^~ 

determine .he actueHloo" S "Lrn^^ , . S,a,,sduan,lt> °' ,h ° dVnami0 m ° del < and ' hs ™<> *«°a« m.ahs 

tloor reaction force ^SS^S^Z^^S^ZT^^ 

and the allowable range (eighteenth aspect of L l„»T„Z) VS ™ bte :."" s,oond ""l ulred ™"'Pblated»ariable, 

moment about a poin of act on of ? loor ^rZlr a manipulated variable related to a floor reaction force's 
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and the correction manipulated variable of the desired floor reaction force so that a difference between, the actual floor 
reaction force manipulated variable and the correction manipulated variable of the desired floor reaction force monot- 
onously changes as the first required manipulated variable increases (twentieth aspect of the invention). 
[0049] According to this, similarly to the thirteenth aspect of this invention, it becomes possible to determine the 
actual floor reaction force manipulated variable and the correction manipulated variable of the desired floor reaction 
force, which enable the error to be close to zero. 

[0050] Moreover, in the eighteenth to twentieth aspects of this invention, as in the case of the fourteenth aspect of 
this invention, it is preferred that the second means determine the actual floor reaction force manipulated variable so 
that a value obtained by adding the actual floor reaction force manipulated variable to the reference instantaneous 
value remains within a predetermined actual floor reaction force allowable range (twenty-first aspect of the invention). 
[0051] According to this, similarly to the fourteenth aspect of this invention, not only the friction force component 
(variable to be limited), but also the floor reaction force component corresponding to the actual floor reaction force 
manipulated variable, that is, the floor reaction force's moment about the point of action of the floor reaction force, the 
position of the point of action of the floor reaction force, and ZMP can remain within desirable allowable range. There- 
fore, stability of behavior of the robot can be even more improved. 

[0052] Furthermore, to be more specific, it is preferred that the twenty-first aspects of the invention has a mode 
similar to that of the sixteenth aspect of this invention. In other words, it is preferred that the second means comprises: 
means for obtaining provisionally determined values of the actual floor reaction force manipulated variable and the 
correction manipulated variable of the desired floor reaction force so that a difference between the actual floor reaction 
force manipulated variable and the correction manipulated variable of the desired floor reaction force becomes at least 
a value corresponding to the first required manipulated variable and that the correction manipulated variable of the 
desired floor reaction force becomes a value corresponding to the second required manipulated variable; means for 
obtaining an estimated value of the variable to be limited corresponding to the new instantaneous value of the desired 
movement when the new instantaneous value of the desired movement is assumed to be determined by the use of 
the obtained provisionally determined value of the correction manipulated variable of the desired floor reaction force; 
means for comparing a value obtained by adding the obtained provisionally determined value of the actual floor reaction 
force manipulated variable to the reference instantaneous value and the estimated value of the variable to be limited, 
to the predetermined actual floor reaction force allowable range and the allowable range of the variable to be limited, 
respectively, and determining a group of the actual floor reaction force manipulated variable and the variable to be 
limited which satisfy limits by the actual floor reaction force allowable range and the allowable range of the variable to 
be limited, respectively, based on a result of the comparison; and means for determining the correction manipulated 
variable of the desired floor reaction force, based on the variable to be limited and a value obtained by subtracting the 
first required manipulated variable from the determined actual floor reaction force manipulated variable (twenty-second 
aspect of the invention). 

[0053] In the twenty-second aspect of this invention, the second required manipulated variable.for causing the state 
quantity of the dynamic model to be close to a predetermined state quantity, is considered in addition to the first required 
manipulated variable. Further, the provisional values of the actual floor reaction force manipulated variable and the 
correction manipulated variable of the desired floor reaction force are determined so that the difference between the 
actual floor reaction force manipulated variable and the correction manipulated variable of the desired floor reaction 
force becomes at least a value corresponding to the first required manipulated variable, and that the correction ma- 
nipulated variable of the desiredf loor reaction force becomes a value corresponding to the second required manipulated 
variable. Apart from the above, this aspect is similar to the sixteenth aspect of this invention. 

[0054] Therefore, according to the twenty-second aspects of this invention, it becomes possible to determine the 
group of the actual floor reaction force manipulated variable and the correction manipulated variable, which are capable 
of causing the errorto be close to zero, improving stability of behavior of the dynamic model, and properly causing the 
actual floor reaction force manipulated variable and the variable to be limited to remain within the allowable range, 
respectively. Thus, stability of behavior of the robot can be improved. 

[0055] Note that it is also possible to searchingly determine the group of the actual floor reaction force manipulated 
variable and the correction manipulated variable of the desired floor reaction force, which satisfy the limitations by the 
actual floor reaction force allowable range and the allowable range of the variable to be limited, respectively. 
[0056] Moreover, in the twenty-second aspect of this invention, as in the case of the seventeenth aspect of this 
invention, it is preferred that a movement of the dynamic model include at least a plurality of movement modes having 
mutually different generation ratios of a floor reaction force's moment to a translation floor reaction force, and that the 
correction manipulated variable of the desired floor reaction force be configured by a plurality of manipulated variables, 
each corresponds to each of the movement modes (twenty-third aspect of the invention). 

[Q057] According!© this, similarly to the seventeenth aspect of this invention, it becomes possible to determine the 
correction manipulated variable which is preferable particularly for causing the variable to be limited to remain within 
the corresponding allowable range. Note that it is also preferable in the twenty-third aspect of this invention that the 
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plurality of movement modes are similar to those of the third or seventh aspect of this invention. 
BRIEF DESCRIPTION OF THE DRAWINGS 

[0058] Flg^ 1 Is a schematic view showing the entire configuration of a biped mobile robot serving as a legged mobile 
robot ,n embodiments of the present invention; Fig. 2 is a block diagram showing a configuration of a control u tt 
provided ,n he robot in Fig. 1 ; Fig. 3 is a block diagram showing a functional configuration of L contro unit ? the firs 

utor 110 m F,g. 3, FIG. 5 ,s an explanatory view exemplifying a running gait of the robot; Fig. 6 is a diagram showino 
an example of setting a desired floor reaction force's vertical component; Fig. 7 is a diagram showlna f^«mnl "f 
setting a desired ZMP; Figs. 8 and 9 are expianatory views of movement modes a S^tSiSZmoS aZbodv 

° f the - r ° b0t; RgS - 10 11 eXP ' ana,0ry VieWS of models oiTo riot n g U is 1 

flowchart showing mam routine processing of a gait generating device in the first embodiment; Fig 1 3 is an explanatory 

7Lt:Zn^z ?nT of the , robot ' s body posjtion; Fig ' 14 is a f, ° wchart sh ° wi ^ •^r.^sss 

of the flowchart m Fig, 1 2; Fig. 15 ,s an explanatory view showing a relation between normal gait's foot landing position/ 
posture and coordinate systems; Fig. 16 is a diagram showing an example of setting a desired floo reaction fo cei 
vertical component of the normal gait; Fig. 17 is a diagram showing an example of setting a floor react on orce'I 

zZ rfhenrr if rT« ,imlt ; f th i no r 9ait; Ra 1 8 is a diagram sh °^ - «A* * jsst«2ss 

ZMP in the normal gait; Fig. 19 is a flowchart showing subroutine processing of the flowchart in Fig 12- Fiq 20 is a 
flowchart showing subroutine processing of the flowchart in Fig. 1 9; Fig. 21 is a flowchart showing subroutine p recess nq 

23 to%„T H ' n 9 -f ; ^ 22 ^ 8 fl ° WChart Sh ° Wing SUbr '° Utine prOC6Ssin 3 of the flowchart Rg 'rFig 9 
23 to 30 are diagrams for explaining processing of essential parts of the flowchart in Fig. 21 ; Fig. 31 is an explanaS 

view showmg an example of a trajectory of the body posrtion in the normal gait; Fig. 32 is a flowchart ^hLinq subroutine 
processing of the flowchart in Fig. 12; Fig. 33 is a diagram showing an example of ^^WSSJSSl 

flowchart mFig. 12, Fig. 35 is a flowchart showing subroutine processing of the flowchart in Fig. 34; Fig 36 is a flowchart 

! ToZ arti) ; Fi°q U 36 e ^ ■ ^ ^ ^ * 3 ^owing'ubroutine proc ssTng of 

flowchart .n F,g. 36, Fig. 38 ,s a d.agram for explaining processing of an essential part of the flowchart in Fiq 37- and 
F.g. 39 ,s an explanatory view showing an example of setting a ZMP allowable range. Fig. 40 is a ftowchart show'nq 
a subroutine processing of the flowchart in Fig. 12; Fig. 41 is a flowchart showing a subroutine Z£ of the 
flowchart ,n F,g. 40; and Fig. 42 is a diagram showing an example of setting a desled floor xZ£5^£S£ 
component ,n a walking gait. Fig. 43 is a block diagram showing a functional configuration of a conto unit inThe secTnd 

Tent ^ 45 fs^a To^lnT™ T* T ° f a 9ait ° e ™*^ ^ The seoon eTo d 

iment, Fig. 45 is a flowchart showing subroutine processing of the flowchart in Fig. 44; and Fig. 46 is a flowchart showing 

ZtTT P rt r0 r S ' Pg ° f f,0WChart ^ Rg ' 45 ' Rg - 47 is 3 block dia 9 ram ^nctionally showing a conflguration of an 
essential part of a gait generating device in the third embodiment; Fig. 48 is a flowchart showing main routing jessing 
of the ga,t generating device in the third embodiment; Fig. 49 is a block diagram functionally showing a gaft generating 
method ,n the third embodiment; Figs. 50 and 51 are explanatory views of perturbation models; and Figs sfto 55 are 
explanatory views of limiting methods of a variable to be limited (a floor reaction force's horizontal component and a 
floor reaction force's moment). Fig. 56 is a block diagram functionally showing a gait generation S Z fourth 

ZstTsT^tf ? b ' 0Ck diagramS f UnCti0na " y 8h ° Wing 3 9ait ^ion Lthod" 

F g. 59 is a block diagram functionally showing a gait generation method in the sixth embodiment; Fig 60 is a block 

diagram showing a modified form of the essential parts in the fourth to sixth embodiments; and Fgs 61 a d 62 are 
explanatory views for explaining conventional technologies. 

BEST MODE FOR CARRYING OUT THE INVENTION 

of aTeloe^obirrohnt ' T T^"" '"T^ ^ de8Cribed hereinbslow ' takin 9 » biped mobile robot as an example 
of a legged mobile robot. Fig. 1 is an explanatory skeleton view showing the entire robot 1 . As shown in the drawino 
the robot 1 includes a pair of right and ieft legs (leg links) 2 and 2 extending downward from- a body 24 Both lgs 2 

n efectric m olTZ^ZoTJ T ^ * ^ ^ ° f -derstanding, each oint is show as 

L r^SlntTn L ^ 1 I' hSSe S ' X J °' ntS are confi 9 ur6d ^ Joints 10R and 10L (Reference Symbols R and 
L represent legs which correspond to the right and left legs, respectively, and the same can be said of the belowWor 
turning the waist (hip) (for rotating the waist in the yaw direction relative to the body 24) , joints 1 2R and 2 fo 2 ting 

u 1 ax's), jo.nts 16R and 16L for rotating knee portions in the pitch direction, joints 18R and 18L for rotatina 
ankle portions in the pitch direction, and joints 20R and 20Lfor rotating ankle portions the roll dirStio , ThiTSS 
are sequentially provided from the body 24. inesejoims 



!NSDOCID:<EP 1475198A1 I > 



9 



EP 1 475 198 A1 

[0060] A foot 22R(L) configuring the end of each leg 2 is attached to the bottom of two joints 1 8R(L) and 20R(L) in 
the ankle portion of each leg 2. The aforementioned body (casing) 24 is also provided at the uppermost positions of 
both legs 2 and 2 through three joints 10R(L), 12R(L) and 14R(L)in the hip of each leg 2. A control unit 26 and the like 
are housed inside the body 24. in Fig. 1 , the control unit 26 is depicted outside of the body 24 for the convenience of 

5 illustration. ■ 

[0061] in each leg 2 having the above configuration, the waist joint (hip joint) is configured by the joints 10R(L), 12R 
(L) and 1 4R(L), the knee joint is configured by the joint 16R(L), and the foot joint (ankle joint) is configured by the joints 
1 8R(L) and 20R(L). Further, the waist joint (hip joint) and the knee joint are connected by a thigh iink 32R(L), and the 
knee joint and the foot joint are connected by a cms link 34R(L). 

10 [0062] Though not illustrated, a pair of right and left arms are attached to both sides of the upper portion of the body 
24, and a head is placed on the top end portion of the body 24. Details of the arms and head are omitted as they are 
not directly related to the gist of this invention. Each arm is provided with a plurality of joints which enable each arm 
to perform movement such as swinging forward and backward relative to the body 24. 

[0063] Each joint mentioned above is made from the electric motor and further provided with a speed reducer and 
15 the like which boosts output. Details of each joint are described in Patent Application No. Heisei 1 -32421 8, Japanese 
Patent Laid-Open Publication No. Heisei 3-1 84782 and the like earlier proposed by the applicant. Further description 
of each joint is omitted as the joint itseif is not related to the gist of this invention. 

[0064] Because of the above-described configuration of each leg 2, the foot 22R(L) of each leg 2 is given six degrees 
of freedom relative to the body 24. The total number of joints of both legs 2 and 2 is 6*2=12. (In this description, 

20 represents multiplication in calculating a scalar and represents an outer product in calculating a vector). When the 
robot 1 is moving, the twelve joints are driven to have appropriate angles. Thus, both feet 22R and 22L can perform 
desirable movements. Accordingly, the robot 1 can arbitrary move a three-dimensional space. 
[0065] The position and velocity of the body 24 described later in this description have meanings of a predetermined 
position of the body 24 and a moving velocity of the position, respectively. Specifically, the predetermined position is 

25 a representative point of the body 24 set in advance (for example, a central point between the right and left hip joints, 
or the like). Similarly, the positions and velocities of the respective feet 22R and 22L have meanings of the positions 
and moving velocities of previously set representative points of the respective feet 22R and 22L In this case, the 
representative points of the respective feet 22 R and 22L in this embodiment are set, for example, on the bottom surfaces 
of the respective feet 22 R and 22L (more specifically, an intersection point between the bottom surface of the each 

30 feet and a perpendicular line extending from the center of the ankle joint of each leg 2 to the bottom surface of each 
of the feet 22R and 22L, or the like). 

[0066] In the robot shown in Fig. 1 , a known six-axis force sensor 36 is provided between the ankle joints 1 8R (L) 
and 20R (L), and the foot 22R(L) of each leg 2. The six-axis force sensor 36 is for detecting whether the foot 22R(L) 
of each leg 2 lands, as well as the magnitude and direction of a force acting on a supporting leg from the floor. This 

35 sensor outputs detection signals to the control unit 26. Outputted signals are detection signals of the transiational 
components Fx, Fy and Fz of the floor reaction force in X, Y and Z directions, transmitted to each leg 2 through the 
foot22R(L) from the floor, and detection signals of moment components Mx, My and Mz about these three directions. 
Further, capacitance type floor contact switches 38 (not shown in Fig. 1 ) for detecting whether each foot 22R(L) contacts 
the floor are provided in the four corners of each foot 22R (L), and the detection signals of the floor contact switches 

40 38 are outputted from the floor contact switches 38 to the control unit 26. In addition, an inclination sensor 40 is mounted 
on the body 24 for detecting an inclination angle (posture angle) of the body 24 relative to the z axis within the X-Z 
plane and Y-Z plane, that is, relative to a gravitational direction (vertical direction), as well as an angular velocity of 
the inclination angle. Detection signals of the inclination sensor 40 are outputted from the inclination sensor 40 to the 
control unit 26. An encoder (rotary encoder) 47 (see Fig. 2) is provided in each electric motor 46 (see Fig. 2) of each 

45 joint for detecting rotation amount of the motor, and the detection signals of the encoders 47 are outputted from the 
encoders 47 to the control unit 26. Furthermore, though not illustrated in Fig. 1 , a zero reference switch 42 for correcting 
outputs from the inclination sensor 40 and a limit switch 44 for fail safe are provided in appropriate positions in the 
robot 1 , and outputs from them are transmitted to the control unit 26. 

[0067] Moreover, though not illustrated, a joystick (manipulator) for controlling the robot 1 is provided outside the 
so robot 1 . The joystick is configured to input requests regarding a gait of the robot 1 to the control unit 26 as necessary, 
by operating the joystick, so that, for example, the robot 1 in a translation movement is turned. In this case, requests 
which can be inputted are, for example, a gait form (walking, running or the like) while the robot 1 is moving, landing 
position/posture and landing time of a free leg, or command data defining the landing position/posture and landing 
time of the free leg (for example, a moving direction, a moving velocity or the like of the robot 1) 
55 [0068] Fig. 2 is a block diagram showing the configuration of the control unit 26. The control unit 26 is configured by 
microcomputers and includes a first calculator 60 and a second calculator 62, each made of a CPU, an AID converter 
50, a counter 56, a D/A converter 66, a waveform shaper 58, a RAM 54, a ROM 64, and a bus line 52 transmitting and 
receiving data between the above. In the control unit 26, the output signals from the six-axis sensor 36 of each leg 2, 
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the inclination sensor 40 and the like are converted into digital values in the A/D converter 50 and thereafter inoutted 
to the RAM 54 thorough the bus line 52. The output from the encoder (rotary encoder) 47 of each o.nt c the To M 
is inputted to the RAM 54 through the counter 56. Further, the outputs from the floor contact switches 38 the zero 

SXTr c l^t' im L S T C t h 4 1 inpUttSd ,0 thS RAM 54 th ™ ah the wavetrm shaper 58 

h. i , ' ° CU ' at0r 60 mentioned above generates a desired gait and also calculates a joint 

angle displacement command (a desired value of each joints displacement angle or a rotational angle of each eEte 
motor 32), and then transmits the desired gait and the command to the RAM 54, The second catculato 62 reaS Z 
the joint angle displacement command and an actual measurement value of the joint angle detected based on the 
output signal from the foregoing encoders 47, from the RAM 54. Thereafter, the second calculator V< aStes ma 
nipulated variables required for driving the respective joints, and outputs the manipulated variables to the elecTric 
motors 46 driving the respective joints, through the D/A converter 66 and servo amplifiers 46a 
Jnn™ 1^ ^° nfi 9 U i rat , i ° n desc »*ed so far is commonly used in any of the embodiments described below 
[0071] Fig. 3 is a block diagram showing the entire functional configuration of the control device of the robot 1 in the 
irst embodiment of this invention. Portions otherthan the "actual robot" in Fig. 3 are configured by process no functions 
(mainly functions of thefirst calculator andthe second calcuiator 62) executed bythe control unftSe^ed^JZ 
below Reference Symbols R and L are omitted when it is not necessary to identify the right and left 1™'°*°"**™ 
[0072] The actuation of the control device of this embodiment is outlined with reference to Fig 3 The control unit 
26 generates a desired gait by the use of a gait generating device 1 00 as described later. The desired gait gene ated 
and outputted by the gait generating device 100 includes desired body position/posture trajectories (R ectories of 
desired position and posture of the body 24), desired foot position/posture trajectories (tr^e^TdiSSiJ 
and posture of each foot 22), desired arm posture trajectories (trajectories of the desired postures of respective anms) 
a desired ZMP (a desired total floor reaction force central point) trajectory, and a desired total floor Sn force 
trajectory. In a case where the body 24, otherthan the legs 2 and the arms, is provided with a movable pomon the 
desired position/posture trajectories of the movable portion are added to the desired gait 

[0073] Here the "trajectory" of the above-mentioned gait means a pattern of temporal changes (time series pattern) 
and includes time series of instantaneous values, each calculated for every control cycle (calcula io process cvc e 
of the ga,t generation device 1 00. "Pattern" will be sometimes used instead of "trajectory" in d^XSSw^K 
posture" means a spatial direction. To be specific, the body posture is expressed by an inclination angle posture 
angle of the body 24 in the roll direction (about the X axis) and an inclination angle (posture angle of the bod 24 n 
the pitch direction (about Y-axis direction), relative to the Z axis (vertical axis). A foot posture is expressed bv spatiL" 

p a oLr r fan 0 ;L W lnTbVrd?n Set TlT^ ^ ^"'^ b °* ^ be=d * « ^ 

posture angle. In a broad sense, the body posture may include relation of the body 24 in the yaw direction (about the 

[0074] m the description below, the term "desired" will be omitted unless the omission causes misunderstandinq 
™p hT" 9 ^ C ° nslituents of the ^ ^ose other than constituents related to the floor reaction toSSS 
ZMP and des-red total floor reaction force), specifically, those related to movement of each portion of the robo 1 s uch 
as the foot position/posture, the body position/posture and the like, are generally called "movement » Further a floor 
reaction force (floor reaction force made up by a translationa, force and a moment) acting on each foot 22 is caZ 
each-foot floor reaction force." A resultant force of the "each-foot floor reaction forces" of all (two) feet 22R and 22L 

° aXSIr la to^h T T reaCti ° n f ° rCe -" ^ deSCriPtiDn b6,0W ' hOWeVer ' thS e-ni otiloofreacti: Irce 
i^tnr^'^^ r reaCt '° n f ° rCe " fe US6d " 3 h3Ving th6 Sam6 aS " t0tal 

[0075] The desired floor reaction force is generally expressed by a point of action as well as a translational force 
and a moment acting on the point. Since the point of action can be anywhere, there are countless ways £ express 
centralolt U^TfT ^ '! ^ emb ° diments of this ^«°»> *e desired ZMP (desired floor L ioXS 
thTn ■ X the P °' nt ° f aCt, ° n ° f the desired floor reaction force ' this case, the moment components of 

he desired floor reaction force, except for a vertical component (a moment about the vertical axis (Z axlT) are zero 

Xand^xS;. T°lTT C ° mPOnentS ° f thS deSiredf, °° r r6aCtion fo ™ ^ ^StoZ^Z 

(X and Y axes)) about the desired floor reaction force central point are zero 

!" the desired gait g^erated by the gait generating device 1 00, the desired body position/posture (trajectories) 
and the desired arm posture (trajectories) are directly transmitted to a robot geometric model (kinematics cilcufator) 

[0077] Moreover, the desired foot position/posture trajectories, the desired ZMP trajectory (desired total floor reaction 

SS^IS 0 ^ and !? desired total fioor reaction force trajecto ^ (spedfica "* a desired 

toTand aTrai iT^t 7°^/^°^ & 6M trM ™ fl °° r reaction force ' s hori2ontal component trajec- 
romnnct J ^ ^ ^ reacX,0n f ° rce ' S moment about the desired ZMP) are directly transmitted o a 

composrte-compliance operation determinator 1 04 and also to a desired floor reaction force distributor 1 06 Ste 
the des.red floor reaction force is distributed to the respective feet 22R and 22L in the desired floor reaction force 



11 

NSDOCID: <EP 1475198A1 I > 



EP 1 475 198 A1 



distributor 106, and the desired each-foot floor reaction force central point and the desired each-foot floor reaction 
force are thus determined. The determined desired each-foot floor reaction force central point and the desired each- 
foot floor reaction force are transmitted to the composite-compliance operation determinator 1 04. 
[0078] In the composite-compliance operation determinator 1 04, corrected desired foot position/posture (trajectories) 
with deformation compensation made up by correcting the desired foot position/posture (trajectories) are obtained, 
and this corrected desired foot position/poslure (trajectories) are transmitted to the robot geometric model 102. Once 
the desired body position/posture (trajectories) and the corrected desired foot position/posture (trajectories) with de- 
formation compensation are inputted, the robot geometric model 1 02 calculates joint displacement commands (values) 
for twelve joints (including 10R(L)) of both legs 2 and 2 to satisfy the above desired positions/postures, "by inverse 
kinematics calculation based on a kinematics model (rigid body link model) of the robot 1 . The robot geometric model 
102 then. transmits the calculated joint displacement commands to a displacement controller 108. The displacement 
controller 1 08 sets the joint displacement commands (values) calculated by the robot geometric model 1 02 as desired 
values and subjects displacement of the twelve joints of both legs 2 and 2 of the robot 1 to follow-up control. The robot 
geometric model 102 also calculates joint displacement commands (values) for the arm joints to satisfy the desired 
arm position and sends the commands to the displacement controller 108. The displacement controller 108 sets the 
displacement commands (values) calculated by the robot geometric model 102 as desired values and subjects dis- 
placement of ten (or eight) joints of the arms of the robot 1 to the follow-up control, 

[0079] The foregoing six-axis force sensor 36 detects a floor reaction force (actual each-foot floor reaction force) , 
generated in the robot 1 by actual movement of the robot 1 owing to the follow-up control mentioned above. The 
detected value is transmitted to the aforementioned composite-compliance operation determinator 104. 
[0080] Further, an actual body posture angle error (error of actual body posture angle from the desired body posture 
angle) which occurred in the robot 1 is detected by the foregoing inclination sensor 36 ; and the detected value is 
transmitted to a posture stability control calculator 112. Based on the actual body posture angle error, the posture 
stability control calculator 112 calculates a compensated total floor reaction force's moment about the desired ZMP 
Mdmd for recovering the actual body posture angle of the robot 1 to the desired body posture angle (causing the actual 
body posture angle error to be close to zero), by using an appropriate feedback control law. 

[0081] To be more specific, in this embodiment, the compensated total floor reaction force's moment Mdmd is de- 
termined by the following equation using, for example, a PD control law. 

Compensated total floor reaction force's moment Mdmd 
= K0b * actual body posture angle error 
+ Kob * actual body posture angular velocity error d25 

[0082] Here, the actual body posture angular velocity error is a time differential of the actual body posture angle 
error, and means an error of an actual body posture angular velocity from a desired body posture angular velocity. The 
actual body posture angle error is specifically a vector made up by posture angle errors in the roll direction (about X 
axis) and the pitch direction (about Y axis) of the body 24 of the robot 1 . The same can be said of compensated total 
floor reaction force's moment Mdmd. 

[0083] The compensated total floor reaction force's moment Mdmd determined as above is distributed into a desired 
floor reaction force's moment for compliance control and a model manipulation floor reaction force's moment, by a 
compensated total floor reaction force's moment distributor 110. In other words, based on the actual body posture 
angle error, the desired floor reaction force's moment for compliance control and the model manipulation floor reaction 
force's moment are determined by the posture stability control calculator 1 12 and the compensated total floor reaction 
force's moment distributor 11 0. 

[0084] The desired floor reaction force's moment for compliance control is a floor reaction force's moment about the 
desired ZMP, generated in the actual robot 1 in order to converge the posture of the actual robot 1 to a desired gait 
(precisely speaking, a corrected gait) and to stabilize (recover) the posture. The model manipulation floor reaction 
force's moment is a floor reaction force's moment about the desired ZMP, generated in a later-described robot dynamic 
model for gait generation for the same purpose as that for the desired floor reaction force's moment for compliance 
control. In other words, the mode! manipulation floor reaction force's moment is a floor reaction force's moment gen- 
erated about the desired ZMP by movement of the ultimately determined desired gait (corrected gait). 
[0085] These floor reaction force's moments are determined in the following manner. First of all, the model manipu- 
lation floor reaction force's moment is determined by the following expression. Floor reaction force's moment allowable 
range is determined by the gait generating device 100 as described later 
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If Mdmd > upper limit of floor reaction force's moment allowable 

range is established, 
"Model manipulation floor reaction force's moment 
= -Mdmd + upper limit of floor reaction force's allowable range" 

is established. 

if Mdmd < iower limit of floor reaction force's moment allowable 

. range is established, 
"Model manipulation floor reaction force's moment 
= -Mdmd + lower limit of floor reaction force's allowable range" 

is established. 

If lower limit of floor reaction force's moment allowable range 
< Mdmd, and Mdmd < upper limit of floor reaction force's moment 

allowable range are established, 
"model manipulation floor reaction force's moment = 0" 

is established. 



626 



EiS r ^ EqUat, ° nS d26 ' the compensated total floor reaction force's moment Mdmd itself is compared with 

or^ a,IOW w b,e r0n9e - What iS to be Q ^™»y ^amd with the flooTrTacSn 

Sinn f ? a,lowab,e » s * P^uct obtained by adding Mdmd to a reference instantaneous value of the floor 

•reaction forces moment about the desired ZMR In this case, the instantaneous value (the horizontarclpfnenm 
the des.red total floor reaction force's moment outputted by the gait generating device 1 00) of the mo^ZSS? 
h f HH r,Z °M? T P ,° nent) ab ° Ut thG dGSired 2MP is a,Wa ^ s U °" in this embodiment. The efore, K^S£SS25 

[0087] Next, the desiredfloorreactionforce'smomert 

Desired floor reaction force's moment for compliance control 

= Mdmd + model manipulation floor reaction force's moment d27 

2 n ^ZT^n^T! l0 ° r T i0 l f ° rCe ' S m ° ment f ° r com P |iance control and the model manipulation floor 
™ f ^ ce s moment are determined so that a difference between them is equal to Mdmd 

SdiTf?? t0 ! a ' f '° 0r reaCti ° n f ° rCe ' S m ° ment distributor 110 < which °P e ^s such operations de- 
scribed above, illustrated in a form of block diagram is as shown in Fig 4 pwauons ae 

[0090] Referring back to Fig. 3, the model manipulation floor reaction force's moment determined above is inoutted 
to the gait generating device 1 00, Thereafter, the gait generating device 1 00 generates movements ^(esoeciatlv a boHv 
posjon/posture trajectories) of the desired gait using the dynamic mode, so that a floor ~ orcX Iment a S 

**» 1 °° ~ - — —on floor =S 
[0091] Further, the desired floor reaction force's moment forcompliance control determined above is inputted to the 
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; 

composite-compliance operation determinator 1 04. The composite-compliance operation determinator 1 04 determines 
the corrected desired foot position/posture (trajectories) with deformation compensation by correcting the desired foot 
position/posture so that an actual floor reaction force's moment about the desired ZMP becomes closer to the desired 
floor reaction force's moment for compliance control, while causing the movement of the robot 1 to follow the movement 

5 of the desired gait generated by the gait generating device 1 00. In this case, it is practically impossible to permit all 
states of the foot posilion/posture and floor reaction force of Ihe robot 1 to coincide with the desired states. Thus, a 
trade-off relation exists between these slates so as to realize a highest possible coincidence. Specifically, control errors 
from individual desired states are weighted, and the corrected desired foot position/posture (trajectories) with defor- 
mation compensation are determined to minimize the weighted average of control errors (or the square of control 

w errors) In other words, the corrected desired foot position/posture (trajectories) with deformation compensation is 
determined so that the actual floor reaction force's moment about the desired ZMP and the actual foot position/posture 
of the robot 1 become closest to the desired floor reaction force's moment for compliance control and the desired foot 
position/posture, respectively. The composite-compliance operation determinator 104 outputs the corrected desired 
foot position/posture to the robot geometric model 1 02 as a final desired value of the foot position/posture, thus con- 

15 trolling the operation of the robot 1. 

[00921 The gist of this invention is mainly about a method of gait generation by the gait generating device 1 00. The 
foregoing conf ig uration and operation of the composite-compliance operation determinator 1 04 and the like are detailed 
in Japanese Patent Laid-Open Publication No. Heisei 10-277969 or the like, earlier applied by the applicant. Thus, the 

description thereof is ended. ... . 

20 [0093] Next the desired gait generated by the gait generating device 1 00 is outlined, taking a running gait shown in 
Fiq 5 as an example In the description below, the term "floor reaction force's vertical component" means a "translation 
floor reaction force's vertical component." The term "moment" is used for the vertical component (component about 
the vertical axis) of a moment of a floor reaction force so as to be distinguished from the "floor reaction force's vertical 
component " Similarly the term "floor reaction force's horizontal component" means a "translation floor reaction force's 

25 horizontal component." Needless to say, the two-leg supporting period in a gait is a period during which the robot 1 
supports the self weight by both legs 2 and 2, and the one-leg supporting period is a period during which the robot 1 
supports the self weight only by any one of the legs 2. The floating period is a period during which both legs 2 and 2 
are separated from the floor (raised in the air). The leg 2 which does not support the self weight of the robot 1 during 
the one-leg supporting period is called a "free leg." In the running gait mainly described in this embodiment, however, 

so the two-leg supporting period does not exist and the one-leg supporting period (landing period) and the floating period 
are alternately repeated. In this case, although both legs 2 and 2 do not support the self weight of the robot 1 during 
the floating period, the leg 2 which was the free leg during the one-leg supporting period immediately before the floating 
period, and the leg 2 which was the supporting leg during the same, are also called free leg and supporting leg, re- 
spectively, during the floating period. . 

35 [0094] First of all, the running gait shown in Fig. 5 is described. This gait is a gait similar to a human s steady running 
gait In this running gait, the one-leg supporting period during which the foot 22 of any one of the right and left legs 2 
(supporting leg) of the robot 1 lands (contacts the floor), and the floating period during which both legs 2 and 2 are 
raised in the air, are alternately repeated. The first state in Fig. 5 shows a (initial) state where the one-leg supporting 
period starts, the second state shows an intermediate state of the one-leg supporting period, the third state shows a 

40 state where the floating period starts following the one-leg supporting period (end of the one-leg supporting period), 
the fourth state shows an intermediate state of the floating period, and the fifth state, shows a state where the floating 
period ends (start of the next one-leg supporting period). 

[0095] As shown in the first state in Fig. 5, the robot 1 in this running gait lands with the heei of the foot 22 on the 
supporting leg side (front leg 2 in the traveling direction of the robot 1 ) at the initial time of the one-leg supporting period. 

45 Subsequently, as shown in the second state in Fig. 5, the robot 1 allows almost entire bottom surface of the landed 
foot 22 (the foot 22 on the supporting leg side) to contact the floor. Thereafter, as shown in the third state in Fig. 5, the 
robot 1 kicks the floor with the toe of the foot 22 on the supporting leg side (the foot 22 of the leg 2 at the back in the 
traveling direction of the robot 1 in the third state in Fig. 5) to jump in the air. The one-leg supporting period is thus 
finished and the floating period starts simultaneously. As shown in the first state in Fig. 5, the free leg in the one-leg 

so supporting period is at the back of the supporting leg at the initial time of the one-leg supporting period, and then swung 
to the front of the supporting leg toward the next expected landing position, as shown in the second and third states 
in Fig 5 Next, after the floating period shown in the fourth state in Fig. 5, the robot 1 lands with the heel of the foot 22 
of the free leg' (the leg 2 which was the free leg during the one-leg supporting period immediately before the floating 
period), and the next one-leg supporting period starts. 

55 [0096] A basic outline of the desired gait generated by the foregoing gait generating device 100 is described in 
consideration of the running gait in Fig. 5. Note that the details regarding a gait are also described in Japanese Patent 
Laid-Open Publication No. Heisei 10-86081 proposed by the applicant of the application concerned. Therefore, the 
description is mainly given regarding the content which is not described in Japanese Patent Laid-Open Publication No. 
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Heisei 10-86081 . 

[0097] Though details are described later, when the gait generating device 100 generates a desired gait, basic re- 
quired values (required parameters) for generating the desired gait, such as landing position/posture (planned landing 
position/posture) and landing time (expected landing time) of the foot 22 on the free leg side, are given to the gait 

5 generating device 1 00 in accordance with desired manipulation or the like of a joystick (manipulator of the robot 1 ) or 
the like. The gail generating device 1 00 then generates the desired gait by using the required parameters. To be more 
specific, the gait generating device 100 determines parameters (referred to as gait parameters) defining a part of 
constituents of the desired gait, such as the desired foot position/posture trajectories and desired floor reaction force's 
vertical component trajectory of the desired gait, in accordance with the aforementioned required parameters. The gait 

10 generating device 100 then sequentially determines instantaneous values of the desired gait by the use of the gait 
parameters and generates a time series pattern of the desired gait. 

[0098] In this case, the desired foot position/posture trajectories (to be more specific, desired trajectories of respective 
spatial components (such as X-axis component) of the position and posture of the foot) are generated for each foot 
22 by the use of, for example, a finite duration settling filter proposed in Patent No. 3233450 by the applicant This 
15 finite duration settling filter is obtained by serially connecting a plurality of stages (three stages or more in this embod- 
iment) of first-order delay filters with variable time constants, that is : filters in which transfer functions are expressed 
by 1/(1+ts). (t represents a variable time constant, and these filters are hereinafter called unit filters.) The filter with 
infinite settling time is enabled to generate and output a trajectory which reaches a designated value at desired des- 
ignated time. In this case, after the finite duration settling filter starts generating outputs, every time constant x of the 
20 unit filter of each stage is sequentially and variably set in accordance with remaining period to the above-mentioned 
designated time. To be more specific, the vaiue of t is set to be reduced from a predetermined initiai value (>0) as the 
remaining period becomes shorter, until the value t ultimately becomes 0 at the designated time at which the remaining 
duration becomes 0. Thereafter, a step input is given to the finite duration settling filter. The step input has a height 
which corresponds to the aforementioned designated value (to be more specific, an amount of change from the initial 
25 value of the output of the finite duration settling filter to the designated value) . This kind of finite duration settling filter 
not only generates an output which reaches a designated value at designated time but also allows a rate of change of 
the output of the finite duration settling filter at the designated time to be zero or nearly zero. In particular, when three 
stages or more (three stages are sufficient) of unit filters are connected, an acceleration of change (differential of the 
change rate) of output from the finite duration settling filter can be zero or nearly zero. 
30 [0099] The foot position/posture trajectories (position/posture trajectories from landing of the foot 22 until the next 
landing thereof) by the use of the finite duration settling filter of this kind are generated, for example, in the following 
manner. For example, the desired foot position trajectory in the X-axis direction (front-and-back direction) is generated 
as follows. The height of step input to the finite duration settling filter is determined in accordance with the next expected 
landing position of each foot 22 In X-axis direction (to be more specific, an amount of change (amount of movement) 
35 of the next planned landing position in the X-axis direction relative to the previous landing position, which is equivalent 
to the foregoing designated value), determined by the foregoing required parameter. At the same time, the foregoing 
time constant x is initialized to be the predetermined initial value. Thereafter, the determined step input is given to the 
finite duration settling filter, and generation of the trajectory of the position of the foot 22 in the X-axis direction starts. 
While the trajectory is generated, the foregoing time constant t is sequentially and variably set to be reduced from the 
initial value to 0 by the expected landing time (equivalent to the foregoing designated time) of the. foot 22. Thus, the 
trajectory of the position of the foot 22 in the X-axis direction is generated, in which the foot 22 reaches the expected 
landing position at the planned landing time. 

[0100] Further, the desired foot position trajectory in the Z-axis direction (vertical direction) is generated in the fol- 
lowing manner, for example. First of all, in accordance with the next expected landing position and expected landing 
45 time of the foot 22, the following are determined: the position of the foot 22 in the Z-axis direction when the height 
(vertical position) of the foot 22 is the greatest (hereinafter, referred to as a peak position) ; and time at which the foot 
22 reaches the peak position. The height of step input to the finite duration settling filter is determined in accordance 
with the peak position (equivalent to the foregoing designated value), and at the same time, the time constant % is 
initialized. Thereafter, the determined step input is given to thef inite duration settling filter, and the. foot position trajectory 
50 in the Z-axis direction to the aforementioned peak position is thus generated sequentially, in this event, the time constant 
t is sequentially and variably set to be reduced from the initiai value to 0 by the time at which the foot 22 reaches the 
peak position (equivalent to the foregoing designated time). Further, once generation of the trajectory of the position 
in the Z-axis direction to the peak position is completed, the time constant % is initialized. At the same time, a step input 
of opposite polarity to that of the step input so far (to be more specific, a step input of opposite polarity having a height 
corresponding to an amount of change (equivalent to the foregoing designated vaiue) in the Z-axis direction, from the 
peak position to the next expected landing position) is inputted to the finite duration settling filter. Thus, the trajectory 
of foot position in the Z-axis direction from the peak position to the expected landing position is sequentially generated. 
In this event, the time constant % is sequentially and variably set to be reduced from the initial vaiue to 0 by the expected 



40 



55 



15 



RNSDOOID: <FP 



147fi19RA1 I ^ 



EP1 475 198 A1 



landing time of the foot 22. 

[0101] The foot position trajectory in theZ-axis direction may also be generated by variably setting the time constant 
i to be continuously reduced from the initial value to 0 from the initial time of trajectory generation until the expected 
landing time of the foot 22, while switching the polarity of the step. input at or around the time at which the foot 22 
reaches the peak position. In this case, the foot 22 cannot reach the desired peak position with high accuracy. However, 
the foot 22 can reach the expected landing position at the expected landing time without any problems. 
[0102] The foot posture trajectory can also be generated by using the Finite duration settling filler, as in the case of 
the above-mentioned foot position trajectory. In this case, the foot posture trajectory can be generated as in the case 
of generation of the aforementioned foot position trajectory in the X-axis direction, with regard to a component of foot 
posture, having a monotonous change (monotonous increase or decrease) in the angle of the posture, among respec- 
tive spatial components of the foot posture. The foot posture can be generated as in the case of generation of the 
foregoing foot-position trajectory in the Z-axis direction, with regard to a component of foot posture, having a maximum 
or minimum value of posture angle, change. 

[0103] The desired foot position/posture trajectories generated by the finite duration settling filter as above are desired 
position/posture trajectories of each foot 22 of a later-described supporting leg coordinate system fixed on the fioor 
surface. 

[0104] The desired foot position/posture trajectories generated as above are generated so that the position of each 
foot 22 starts moving from its initial floor contacting state (state of the desired gait at initial time), while gradually 
accelerating toward the expected landing position. The desired foot position/posture trajectories are generated so that 
a rate of change of the position of the foot 22 is gradually reduced to ultimately become zero or nearly zero by the 
expected landing time, and that the foot 22 stops when it reaches the expected landing position at the expected landing 
time. Thus, a ground speed (rate of change of the position of each foot 22 at the supporting leg coordinate system 
fixed on the fioor) at the landing moment of each foot 22 becomes zero or nearly zero. Therefore, a landing impact 
becomes small even if the foot 22 lands from the state where both legs 2 and 2 are in the air at the same time (state 
of the floating period) in the running gait. 

[0105] In the running gait, a vertical velocity of the body 24 is downward from the latter half of the floating period due 
to the gravity acting on the robot 1. The vertical velocity is still downward at landing time. Therefore, the desired foot 
position/posture trajectories are generated such that the ground speed of each foot 22 at the landing moment becomes 
zero or nearly zero, as described above. At the same time, when generating the desired position/posture trajectories 
of the body 24 to satisfy dynamic equilibrium conditions as described later, the velocity of the foot 22 on the free leg 
side relative to the body 24 becomes upward immediately before landing. Specifically, the desired gait of the robot 1 
is generated as a gait in which the leg 22 on the free leg side lands while pulling the leg toward the body 24 at the 
landing moment in the running gait, In other words, in the desired gait of this embodiment, the robot 1 lands while lifting 
the foot 22 on the free leg side toward the body 24 so that the ground speed of the foot 22 on the free leg side at the 
landing moment becomes zero or nearly zero. Thus, the landing impact becomes small, preventing the landing impact 
from being too large. 

[0106] In this embodiment, the finite duration settling filter includes three or more stages (for example, three stages) 
of unit filters serially connected, Therefore, the velocity of each foot 22 (rate of change of the foot position) becomes 
zero or nearly zero by the expected landing time. In addition, the acceleration of each foot 22 becomes zero or nearly 
zero at the expected landing time, and the foot 22 stops. In other words, the ground acceleration at the landing moment 
becomes zero or nearly zero. Hence, the landing impact is further reduced. In particular, even if landing time of the 
actual robot 1 deviates from the desired landing time, the impact does not increase so much. A supplement description 
is provided. The number of stages of unit filters of the finite duration settling filter may be two for realizing zero or nearly 
zero ground speed of each foot 22 at the expected landing time. However, the acceleration of each foot 22 at the 
expected landing time does not generally become zero in this case. 

[0107] After each foot 22 lands with the heel at the expected landing time, the foot posture keeps moving until almost 
entire bottom surface of the foot 22 contacts the floor. Thus, time at which almost entire bottom surface of the foot 22 
contacts the floor is set as the foregoing designated time, and the foot posture trajectory is generated by the foregoing 
finite duration settling filter. 

[0108] In this embodiment, the foot position trajectory is generated by the use of the finite duration settling filter. The 
foot position trajectory may also be generated by the use of a function such as a polynomial which is set so that the 
rate of change of the foot position at the expected landing time becomes zero or nearly zero (time differential of the 
foot position becomes zero), and further, that the acceleration of change (time differential of the rate of change) of the 
foot position at the planed landing time becomes zero or nearly zero. The same can be said of generation of the desired 
foot posture trajectory. Note that, as for generation of the desired foot posture trajectory, a function such as a polynomial 
is set so that, as mentioned earlier, the rate of change as well as the acceleration of change of each foot 22 becomes 
zero or nearly zero at time at which almost entire surface of each foot 22 contacts the floor. 

[0109] The gait generating device 100 explicitly sets a desired floor reaction force's vertical component. The desired 



16 



10 



15 



20 



25 



30 



35 



40 



45 



50 



55 



EP 1 475 198 A1 

floor reaction force's vertical component trajectory is set, for example, as shown in Fig. 6. In this embodiment a shape 
of the desired floor reaction force's vertical component trajectory in the running gait (specifically, a shape in the one- 
leg supporting period) is specified to be trapezoid (projecting shape to the increasing side of floor reaction force's 
vertical component). The height of the trapezoid and times of break points thereof are determined as gait parameters 
(floor reaction force's vertical component trajectory parameters) which define the desired floor reaction force's vertical 
component trajectory. During the floating period in the running gait, the desired floor reaction force's vertical component 
is normally set to zero. It is preferred to set the desired floor reaction force's vertical component trajectory to be sub- 
stantially continuous (to prevent values from being discontinuous) like this example. This is for realizing smooth oper- 
ations of the joints of the robot 1 when a floor reaction force is controlled. Here, the expression "substantially continuous" 
means the following. When a trajectory which is continuous in an analog manner (continuous trajectory in a true sense) 
is represented in a digital manner by a discrete time system, discontinuous values are consequently generated. How- 
ever, the discontinuous values do not cause a loss of continuation of the trajectory. 

[0110] A desired ZMP trajectory is set as follows. In the running gait in Fig. 5, as mentioned earlier, the robot 1 lands 
with the heel of the foot 22 on the supporting leg side, then kicks the floor with the toe of the foot 22 to jump in the air, 
and finally lands with the heel of the foot 22 on the free leg side. Therefore, as shown in the upper diagram in Fig. l\ 
the desired ZM P trajectory is set as follows. The heel of the foot 22 on the supporting leg side is set as an initial position' 
and the desired ZMP moves to the center in the front-and-back direction of the foot 22 during a period when almost 
entire bottom surface of the foot 22 on the supporting leg side contacts the floor. Thereafter the desired ZMP moves 
to the toe of the foot 22 on the supporting leg side by lifting time. The upper diagram in Fig. 7 shows the desired ZMP 
trajectory in the X-axis direction (front-and-back direction), and the lower diagram in Fig. 7 shows the desired ZMP 
trajectory in the Y-axis direction (right-and-left direction). As shown in the lower diagram in Fig. 7, the desired ZMP 
trajectory in the Y-axis direction in the one-leg supporting period is set at the same position as the central position of 
the ankle joint of the leg 2 on the supporting leg side in the Y-axis direction. 

[0111] As shown in the upper diagram in Fig. 7, the position in the X-axis direction in the desired ZMP trajectory 
during the floating period is set to continuously move from the toe of thefoot 22 on the supporting leg side to the landing 
position of the heel of the foot 22 on the free leg side, by the next leg 2 on the free leg side lands. In addition, as shown 
in the lower diagram in Fig . 7, the position in the Y-axis direction in the desired ZMP trajectory during the floating period 
is setto continuously move from the central position in the Y-axis direction of the ankle joint of the leg 2 on the supporting 
leg side to the central position in the Y-axis direction of the ankle joint of the leg 2 on the free leg side, by the next leg 
2 on the free leg side lands, In other words, the desired ZMP trajectory is setto be continuous (substantially continuous) 
over the entire gait period. The earlier-stated expression "substantially continuous" used for ZMP trajectory has the 
similar meaning to that for the foregoing floor reaction force's vertical component trajectory. 

[0112] Considering approximation accuracy orthe like of the dynamic model used for generation of the desired gait, 
it is preferred that the desired ZMP trajectory be substantially continuous even during the floating period as mentioned 
above, in order to cause a desired movement of the desired gait to be as continuous as possible. However, in the later- . 
described dynamic model used in this embodiment, the desired ZMP is not necessarily continuous. Further, in this 
embodiment, the positions and times of break points of the desired ZMP trajectory shown in Fig. 7 are set as ZMP 
trajectory parameters (parameters defining the desired ZMP trajectory). 

[0113] The ZMP trajectory parameters are determined so that the ZMP trajectory has high stability margin and does 
not change suddenly. Here, the expression "high stability margin" is referred to as a state where the desired ZMP exists 
near the center of a smallest projecting polygon (so-called supporting polygon) including the contact surface of the 
robot 1 (see Japanese Patent Laid-Open Publication No. Heisei 10-86081). The desired ZMP trajectory in Fig. 7 is set 
to satisfy this condition. 

[0114] The desired arm postures are expressed by postures relative to the body 24. 

[0115] The desired body position/posture, the desired foot posture/position and later-described reference body pos- 
ture are described by global coordinate systems. The global coordinate systems are coordinate systems fixed on the 
floor More specifically, later-described supporting leg coordinate systems are used. 

[0116] In this embodiment, the gait generating device 100 generates not only the desired body posture but also 
reference body posture. The reference body posture is a body posture generated by faithfully following requests to the 
gait (requests from a device such as a behavior planner or outside (such as the foregoing joystick) to the gait generatinq 
device 100). 

[01 17] The desired body posture (hereinafter, body posture without "reference" means the desired body posture) is 
generated to follow or coincide with the reference body posture in a long term basis. 

[0118] In the walking gait, the desired body posture can always coincide with the reference body posture, like an 
embodiment described in the description of Patent Application No. 2000-352011 by the applicant of the application 
concerned. In Patent Application No. 2000-352011 , the concept of reference body posture is not described, but a 
desired body posture pattern is explicitly and preferentially given. This means the same as that the desired body posture 
always coincides with the reference body posture. 
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[0119] However, in a gait, such as running having the floating period and a gait on a floor with low friction, merely 
adjusting a body horizontal acceleration does not satisfy the dynamic equilibrium conditions while maintaining a floor 
reaction force's horizontal component of the desired gait within a allowable range (or within a friction limit). 
[0120] Therefore, in this embodiment, the desired body posture is deliberately shifted from the reference body posture 
as necessary. To be more specific, by compositionally generating two movement modes described below, the floor 
reaction force's horizontal component of the desired gaiL is maintained within the allowable range (or within the friction 
limit). 

[0121] As shown in Fig. 8, when only the body horizontal acceleration is perturbated (slightly changed) from a certain 
movement state of the robot 1 , total center- of -gravity horizontal acceleration and angular momentum about the total 
center of gravity of the robot 1 are perturbated. Specifically, a perturbation of the body horizontal acceleration causes 
perturbations of the component of the floor reaction force's moment about the desired ZMP (excluding the component 
about the vertical axis) and the floor reaction force's horizontal component, without causing a perturbation of the floor 
reaction force's vertical component which dynamically balances with the resultant force of the inertial force and gravity 
of the robot 1 generated by the perturbation of the body horizontal acceleration (without causing a perturbation of the 
total center of gravity's vertical acceleration of the robot 1), The movement mode causing a perturbation of the body 
horizontal acceleration of the robot 1 is referred to as a body translation mode. 

[0122] In other words, the body translation mode is referred to as movement which changes the component of the 
floor reaction force's moment (excluding the component about the vertical axis) about the desired ZMP and the floor 
reaction force's horizontal component, without changing the floor reaction force's vertical component. 
[0123] A change of the component of the floor reaction force's moment per unit acceleration at this time is denoted 
by AMp, and a change of the floor reaction force's horizontal component per unit acceleration is denoted by AFp. When 
the body 24 is accelerated horizontally toward the front in the situation shown in Fig: 8, AMp and AFp act in directions 
of arrows shown in Fig. 8. 

[01 24] For better sensory understanding , the floor reaction force balancing out the resultant force of the inertial force 
and gravity generated by movement is used to express the floor reaction force's vertical component. However, it is 
more theoretically appropriate to use the resultant force of the inertial force and gravity to express the floor reaction 
force's vertical component. This resultant force and the floor reaction force have the same magnitude in the opposite 
directions to each other. 

[0125] On the other hand, when a body posture angular acceleration (angular acceleration of the posture angle of 
the body 24) is perturbated about a certain point Pr from a certain movement state of the robot 1 as shown in Fig, 9, 
the total center of gravity of the robot 1 is not perturbated but the angular momentum about the total center of gravity 
is perturbated. In other words, the perturbation of the body posture angular acceleration about the point P'r does not 
cause perturbations of the floor reaction force's vertical component and the floor reaction force's horizontal component, 
but causes a perturbation of the component of the floor reaction force's moment about the desired ZMP (excluding the 
component about the vertical axis). The movement mode causing a perturbation of the body posture angular acceler- 
ation of the robot 1 is referred to as a body rotation mode. 

[0126] in other words, the body rotation mode is referred to as a movement changing the component of the floor 
reaction force's moment about the desired ZMP (excluding the component about the vertical axis), without changing 
the floor reaction force's vertical component and the floor reaction force's horizontal component. 
[0127] A change of the component of the floor reaction force's moment per unit angular acceleration at this time is 
denoted by AMr, and a change of the floor reaction force's horizontal component per unit angular acceleration Is denoted 
by AFr. AFr is zero. When angular acceleration of the body posture angle Is generated so that the body 24 inclines to 
the front in the state shown in Fig. 9, AMr acts in the direction of the arrow shown in Fig. 9. 

[0128] Next, description is given regarding a robot dynamic model used for gait generation in this embodiment. In 
this embodiment, a below-described simplified (approximated) dynamic model is used. However, a kinematics model 
(a model expressing structures and dimensions of joints and links, in other words, a model expressing a relation be- 
tween joint displacement and link position/posture) is also required as far as this dynamic model described below is 
concerned. 

[0129] Fig. 10 shows the robot dynamic model used in this embodiment. As shown in the drawing, this dynamic 
model is configured by three material particles in total, including two material particles 2m and 2m corresponding to 
the legs 2 and 2 of the robot 1 , respectively, and a material particle 24m corresponding to the body 24, as well as a 
flywheel FH having inertia but no mass. In this dynamic model, dynamics of the legs 2 and 2 (dynamics of the respective 
material particles 2m and 2m) and dynamics of the body 24 (dynamics of the material particle 24m and flywheel FH) 
are configured to be decoupled, thatls, not to interfere with each other. At the same time, dynamics of the entire robot 
1 is expressed by linear combination of dynamics of the above material particles. In addition, a relation between a 
movement of the body 24 and the floor reaction force is separated into a relation between the translation movement 
(body translation mode) of the body 24 and the floor reaction force, and a relation between the rotation movement 
(body rotation mode) of the body 24 and the floor reaction force. To be specific, a floor reaction force generated by a 
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horizontal movement of the body material particle 24m corresponds to a floor reaction force generated by a translation 
movement (body translation mode) of the body 24 in the horizontal direction. A floor reaction force generated bv a 

^Hl?oT eme ? t ° f f ! yWf T!' corres P° nds 10 the floor reactionforcegeneratedby rotation movement (body rotation 
mode) of the posture angle of the body 24, 

^ [0130] Note that masses of arms of the robot 1 are included in the body 24, and the body material particle 24m has 
a mass .nclud.ng the masses of arms. In this embodiment, as described laLer, movements of arms (arm swinging 
movements) m the desired gait are performed so that the total center of gravity of both arms relative to the body 24 
f T kT 6 ' * hlle u cancelin 9 an inertial force's moment aboutthe vertical axis generated in the robot 1 by a movement 

10 fill™ ; f ? a " am SWin9in9 movements - Thus - influences of arm swinging movements on the floor reaction 

areTgnoreT (eXClUdmg & m ° ment about the vertical axis ) and on the «°<" reaction force's horizontal component 

[0131] The above-mentioned simplified model is formulated hereinbelow. However, in order to simplify description 
only equations of movement on a sagittal plane (a plane including a front-and-back axis (X axis) and a vertical axis (Z 

15 Z'SLT f-^ u qUati ° n °L movement on a lateral P |ane (a Plane including a right-and-left axis (Y axis) and the 
is vertical axis (Z axis)) are omitted. ' 

h°J 32] XH F ° r ^ C + ° nvenience | of description, functions and parameters related to the dynamic model are defined as- 
below. The respective material particles 2m ; 2m and 24m correspond to either representative points of corresponding 
portions, or points geometrically and uniquely determined from the positions/postures of the corresponding portions 
For example the position of the material particle 2m of the leg 2 on the supporting leg side is set to be a point above 
-o the aforementioned representative point of the bottom surface of the foot 22 of the leg 2 by a predetermined distance. 

Zsup: supporting leg material particle's vertical position 
Zswg: free leg material particle's vertical position 

Zb; body material particle's vertical position (generally different from a body vertical position) 
■ 5 ZGtotal: total center- of-gravity vertical position 

Xsup: supporting leg material particle's horizontal position 
Xswg : free leg material particle's horizontal position 

Xb: body material particle's horizontal position (This is a point offsetting forward or backward from the aforemen- 
tioned I point Pr by a predetermined distance. Offset is determined so that a center of gravity of a precise model 
comcides with the center of gravity of the dynamic model as much as possible when, for example the robot 1 is 
standing upright. This point is generally different from the body horizontal position ) 
XGtotal: total center-of-gravity horizontal position 

eby: body posture angle (inclination angle) about Y axis relative to vertical direction 
mb: body material particle's mass 
5 msup; supporting leg material particle's mass 

mswg: free leg material particle's mass 
mtotal: total robot mass (= mtotal + msup +• mswg) 

J : body's moment of inertia (This is an equivalent moment of inertia in the body rotation mode and does not generally 
coincide with a inertia moment of the body 24 of the actual robot 1 .) 
> Fx: floor reaction force's horizontal component (Specifically, this is a (X axis) component in the front-and-back 

direction of a translation floor reaction force.) 

Fz: floor reaction force's vertical component (Specifically, this is a (Z axis) component in the vertical direction of a 
translation floor reaction force, and is equivalent to a desired translation floor reaction force's vertical component 
in this embodiment.) r 

My: floor reaction force's moment about desired ZM P (Specifically, this is a component of the floor reaction force's 
moment about the right-and-left axis (Y axis)) 

[0133] Note that, in this embodiment, a relation between the position of the material particle 2m of each leg 2 and 
the position of the foot 22 of the leg 2 (position of the representative point of the foot 22 determined in advance) is set 
Z 11T' T°! ° nS ° f P0Siti0nS iS determine ^ the o^r position is uniquely set, Further, a relation between 

h! k n Z I ? dy matena ' PartiC ' e 24m aPd the P ° sition of the boc| y 24 <P° sition of representative point of 
the body 24 set in advance) is set in advance in accordance with the posture angle of the body 24. Thus the posture 
angle and the position of one side are determined, the position of the other side is uniquely set ' 

^! 4] ri . ff F ° r T*™ ra % Va l' able X ' dX/dt re P resents a first-order differential of X, and d2X/dt2 represents a second- 
orde differential of X. Therefore, if the variable X represents displacement, dX/dt means a velocity, andd2X/dt2 means 
acceleration, g represents a gravity acceleration constant. Here, g is set to be a positive value 

[0135] Equations of movement (equations expressing dynamic equilibrium conditions) of the foregoing dynamic mod- 
el are expressed by Equations 01 , 02 and 03. 9 u y ,,dmicmoa 
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Fz - mb*(g+d2Zb/dt2) + msup*(g+d2Zsup/dt2) 

+ mswg*(g+d2Zswg/dt2) Equation 01 

Fx = mb*d2Xb/dt2 + msup*d2Xsup/dt2 + mswg*d2Xswg/dt2 Equation 02 

My = -mb*(Xb~Xzmp)*(g4-d2Zb/dt2) + mb*(Zb-Zzmp)*(d2Xb/dt2) 

- msup*(Xsup~Xzmp)*(g+d2Zsup/dt2) 
'+ msup*(Zsup-Zzmp)*(d2Xsup/dt2) 

- mswg*(Xswg-Xzmp)*(g+d2Zswg/dt2) 

+ mswg*(Zswg~Zzmp)*(d2Xswg/dt2) + J*d2Bby/dt2 Equation 03 

20 [0136] Further, the following relational expressions are applied to the total center of gravity of the robot. 

ZGtotal = (mb*Zb + msup*Zsup + mswg*Zswg)/rntotal Equation 04 

25 XGtotai » (mb*Xb + msup*Xsup + mswg*Xswg)/mtotal Equation 05 

[0137] Relations between the foregoing dynamic model and aforementioned AFp, AMp, AFr and AMr are described 
below. 

30 [0138] In Equation 02, AFp is a perturbation amount of Fx when d2Xb/dt2 is perturbated by a unit amount, and thus 
obtained by the following equation. 

AFp - mb Equation 06 
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In other words, a change AFp of the horizontal component of the floor reaction force per unit acceleration in the body 
translation mode is equivalent to the mass of the body material particle 24m of the foregoing dynamic model. 
[0139] In Equation 03, AMp is a perturbation amount of My when d2X/dt2 is perturbated by unit amount, and thus 
obtained by the following equation. 

AMp - mb*(Zb-Zzmp) Equation 07 



In other words, a change AMp of the component of the floor reaction force's moment per unit acceleration in the body 
45 translation mode is obtained by multiplying the mass of the body material particle of the foregoing dynamic model by 
a height (vertical position) of the body material particle 24m from the desired ZMP. The relation between the positions 
of the body material particle 24m and the desired ZMP and a movement of the body material particle 24m at this time 
is equivalent to behavior of an inverted pendulum when the body material particle 24m corresponds to an inverted 
pendulum material particle and.the desired ZMP corresponds to an inverted pendulum fulcrum, respectively. 
50 [0140] In Equation 02, AFr is a perturbation amount of Fx when d26by/dt2 is perturbated by unit amount, and thus 
obtained by the following equation. 

AFr = o Equation 08 



In other words, a change AFr of the translation floor reaction force's horizontal component per unit acceleration in the 
body rotation mode Is zero. 

[0141] In Equation 03, AMr is a perturbation amount of My when d20by/dt2 is perturbated by unit amount, and thus 
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obtained by the following equation. 



AMr = J Equation 09 



In other words, a change AMr of the component of the floor reaction force's moment per unit acceleration in the body 
rotation mode is equivalent to the inertia moment of the flywheel. 

[0142] In the gait generating device 1 00 in this embodiment, a desired gait for one step from landing of one leg 2 of 
the robot 1 to landing of the other leg 2 is set as a unit, and the desired gait for one step is sequentially generated. 
Therefore, as for the running gait in Fig. 5 generated in this embodiment, the desired gait from initial time of the one- 
leg supporting period to end time of the following floating period (initial time of the next one-leg supporting period) is 
sequentially generated. In this description, "one step" of the desired gait is used to mean the duration from the landing 
of one leg 2 of the robot 1 until the landing of the other leg 2. Further, the desired gait which to be newly generated is 
called a "current time gait", the following desired gait is called a "next time gait", and the next following desired gait is 
called a "next but one time's gait." In addition, the last desired gait generated before the "current time gait" is called a 
"last time gait." 

[01 43] Moreover, when the gait generating device 1 00 newly generates a current time gait, required values (requests) 
of a expected landing position/posture and expected landing time of the foot 22 on the free leg side of the robot 1 for 
the next two steps are inputtedto the gait generating device 100 as required parameters forthe gait (alternatively, the 
gait generating device 1 00 reads the required parameters from a storage device). By the use of these required paranv 
eters, the gait generating device 1 00 then generates desired body position/posture trajectories, desired foot position/ 
posture trajectories, a desired ZMP trajectory, a desired floor reaction force's vertical component trajectory, a desired 
arm posture trajectory and the like. At this time, a part of the gait parameters defining these trajectories is corrected 
as appropriate to ensure continuity of the gait. 

[0144] Details of gait generation processing by the gait generating device 1 00 are described hereinbelow with ref- 
erence to Figs. 12 to 41, taking generation of the running gait in Fig. 5 as a main example. Fig. 12 is a flowchart 
(structured flowchart) showing gait generating processing executed by the gait generation device 100. 
[0145] First of all, in S01 0, various initialization operations are performed such as initialization of time t to zero. This 
processing is performed when the gait generating device 100 starts, for example. Next, processing proceeds to S014 
via S012 and the gait generating device 100 waits for the timer interruption for each control cycle (calculation process 
cycle of the flowchart in Fig. 12). The control cycle is represented by At. 

[0146] Next, processing proceeds to S016, it is determined whether a gait transition is detected or not. If the gait 
transition is detected, processing proceeds to S018, otherwise the process proceeds to S030. This "gait transition" 
herein means a timing at which generation of the last time gait is completed and generation of the current time gait 
starts. The gait transition is, for example, a control cycle following a control cycle in which generation of the last time 
gait is completed, 

[01 47] When processing proceeds to S01 8, time t is initialized to zero, and then processing proceeds to S020 where 
the next time gait's supporting leg coordinate system, the next but one time gait's supporting leg coordinate system, 
the current time gait's period and the next time gait's period are read. These supporting leg coordinate systems and 
gait periods are defined by the foregoing required parameters. In other words, in this embodiment, the required pa- 
rameters that the gait generating device 100 is given by the joystick or the like include the required values of the 
expected landing position/posture (foot position/posture in a state where the foot 22 is rotated without slipping so that 
almost entire bottom surface contacts a floor surface after the foot 22 lands) and the expected landing time of the foot 
22 on the free leg side, for next two steps. The required values for the first step and the second step, corresponding 
to the current time gait and the next time gait, respectively, are given to the gait generating device 100 before initial 
time of generation of the current time gait (before a gait transition earlier described in S01 6). The required values can 
be changed while generating the current time gait. 

[01 48] Thereafter, the next time gait's supporting leg coordinate system is determined in accordance with the required 
values of the expected landing position/posture of the foot 22 on the free leg side of the first step (foot 22 on the free 
so leg side in the current time gait) by the foregoing required parameters. 

[0149] Referring to Fig. 15, for example, it is assumed that the required values of the expected landing position/ 
posture of the foot 22 on the free leg side (22L in the drawing) related to the current time gait (first step) are set as 
position/posture obtained as follows. The position/posture is moved from the landing position/posture of the foot 22 on 
the supporting leg side (22R in the drawing) of the current time gait, by xnext and ynext in the X-axis direction (front- 
and-back direction of the foot 22R on the supporting leg side of the current time gait) and the Y-axis direction (right- 
and-left direction of the foot 22R on the supporting leg side of the current time gait) of the current time gait's supporting 
leg coordinate system, respectively, and is rotated about the Z axis (about the vertical axis) by Oznext Here, the sup- 
porting leg coordinate system is a coordinate system fixed on a floor. The origin of the supporting leg coordinate system 
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is set to a point where a perpendicular extending from the center of the ankle of the leg 2 on the supporting leg side 
intersects with a floor surface in a state where the foot 22 on the supporting leg side is horizontally postured (more 
generally, postured in parallel with a floor surface), causing almost entire bottom surface of the foot 22 on the supporting 
leg side to (closely) contact the floor surface. (The above point coincides with the representative point of the foot 22 

5 on the supporting leg side in the state where almost entire bottom surface of the foot 22 contacts the floor surface in 
an example of this embodiment.) In the supporting leg coordinate-system, a horizontal plane passing through the origin 
is set to be an XY plane. In this case, the X-axis direction and Y-axis direction are the front-and-back direction and the 
right-and-left di rectio.n of each foot 22 on the supporting leg side, respectively. The origin of the supporting leg coordinate 
system does not have to coincide with the representative point of the foot 22 (point representing the position of the 

10 foot 22) in the state where almost entire bottom surface of the foot 22 on the supporting leg side contacts the floor 
surface. The origin may be set as a point on the floor surface, which differs from the representative point 
[01 50] In this case, the next time gait's supporting leg coordinate system is a coordinate system whose origin is the 
representative point of the foot 22L (more specifically, a point on the floor, which coincides with the representative 
. point) in a case where the foot 22 is landed in accordance with the required values of the expected landing position/ 

15 posture of the foot 22L on the free leg side of the current time gait as shown in the drawing (in a case where the 
representative point of the foot 22 is caused to coincide with the required value of the expected landing position, and 
the posture (orientation) of the foot 22 is caused to coincide with the required value of the expected landing posture). 
In the next time gait's supporting leg coordinate system, the front-and-back direction and right-and-left, direction of the 
foot 22 within the horizontal plane passing through the origin are set as an X'-axis direction and a Y'-axis direction, 

20 respectively. 

[0151] As. in the case of the above, the next but one time gait's supporting leg coordinate system (see X" and Y" 
coordinates in Fig. 15) is defined in accordance with the required values of the expected landing position/posture of 
the foot 22 on the free leg side of the second step. Further, the current time gait's period is defined as a duration from 
the (required value of) expected landing time of the foot 22 on the supporting leg side of the current time gait until (the 
25 required value of) the expected landing time of the foot 22 on the free leg side of the first step (current time gait). The 
next time gait's period is defined as a duration from (the required value of) the expected landing time of the foot 22 on 
the free leg side of the first step until (the required value of) the expected landing time of the foot 22 on the free leg 
side of the second step. 

[0152] In this embodiment, the foregoing required parameters are inputted to the gait generating device 100 by 
30 required manipulation of the joystick. However, the required parameters or corresponding positions/postures of the 
aforementioned supporting leg coordinate systems and gait periods may be stored in advance as a movement schedule 
of the robot 1 . Alternatively, the next time gait's supporting leg coordinate system and next but onetime gait's supporting 
leg coordinate system as well as the present and next time gait's periods may be determined based on commands 
(requests) from a manipulator such as a joystick, and a history of movements of the robot 1 before the commands are 
35 given. 

[0153] Next, processing proceeds to S022, where the gait generating device 10.0 determines gait parameters of a 
normal turning gait serving as a virtual cyclic gait which follows the current time gait. The gait parameters include foot 
trajectory parameters defining desired foot position/posture trajectories in the normal turning gait, reference body pos- 
ture trajectory parameters defining the body posture trajectory as a reference, arm trajectory parameters defining the 
40 desired arm posture trajectories, ZM P trajectory parameters defining a desired ZMP trajectory, and floor reaction force's 
vertical component trajectory parameters defining a desired floor reaction force's vertical component trajectory. Addi- 
tionally, parameters defining a desired floor reaction force's horizontal component allowable limit are included in the 
gait parameters. 

[0154] In this description, the "normal turning gait" is used to mean a cyclic gait in which states of movement of the 
45 robot 1 (states of foot position/posture and body position/posture) will not be discontinuous at a boundary of gait (in 
this embodiment, a boundary of gait for each step) when the normal turning gait is repeated. Hereinbelow, the "normal 
turning gait" may be abbreviated as a "normal gait." - 

[0155] In this embodiment, in the normal turning gait, which is a cyclic gait, is configured by repeating a gait for one 
cycle. The gait for one cycle of the normal turning gait is a gait of two steps of the robot 1 , that is, a gait including the 

so first turning gait following the current time gait and the second turning gait following the first turning gait. The reason 
why the term "turning" is used is because zero turning rate means straight travel and therefore straight travel can be 
included in turning in a broad sense. Further, when the desired gait to be generated is the foregoing running gait in 
Fig. 5, the current time gait of the desired gait is the running gait having the one-leg supporting period and the floating 
period. Thus, any of the first turning gait and the second turning gait of the normal turning gait is the gait having the 

55 one-leg supporting period and the floating period, as in the case of the current time gait. In short, the basic gait forms 
of the first turning gait and the second turning gait are the same as that of the current time gait. 
[01 56] A supplementary description is given with regard to the normal turning gait. In a biped mobile robot, the normal 
turning gait for one cycle requires a gait with at least two steps in a narrow sense described above. It is also possible 
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to set a complicated normal turning gait in which a gait with three or more steps is set as the gait for one cycle However 
the normal turning gait is used only for determining a divergence component (to be detailed later) at the end (end time) 
of the current time gait, as stated later. Therefore, a use of the normal turning gait, in which a gait of three or more 
steps is set as the gait for one cycle, does not produce effects so much, although it results in complex processing of 
gait generation. Thus, the gait for one cycle of the normal turning gait In this embodiment is configured by the gait of 
two steps (the first and second turning gaits). As for a legged mobile robot with three or more legs, Lhe number of gaits 
sufficient to define a normal turning gait increases In accordance with the number of legs. For the convenience of 
explanation, the normal turning gait made of a plurality of gaits in a narrow sense (gaits, each including two steps in 
this embodiment), is regarded as a one step of gait hereinbelow. 

[0157] The normal turning gait is temporarily produced in the gait generating device 1 00 for determining a state of 
movement of the robot 1 such as a divergence component, a body vertical position velocity, a body posture angle and 
its angular velocity and the like at the end of the current time gait. The normal turning gait is not outputted as it is from 
the gait generating device 100. 

[0158] Note that the "divergence" means that the position of the body 24 of the biped mobile robot 1 is shifted to a 
position significantly away from the positions of both feet 22 and 22, as shown in Fig. 13. The value of the divergence 
component is a numerical value expressing a situation where the body 24 of the biped mobile robot 1 shifts away from 
the positions of both feet 22 and 22 (more specifically, from the origin of a global coordinate system (supporting leq 
coordinate system) set on the contact surface of the foot 22 on the supporting leg side). 

[0159] In this embodiment, a gait is produced with reference to the divergence component so that a desired gait is 
continuously generated without causing divergence described above. However, the normal gait, a typical example of 
a continuous gait (a cyclic gait with the same pattern which can be repeated without causing a discontinuity of gait 
trajectory; gait having no divergence in principle even if the gait is repeated infinite times) has an initial divergence 
component (divergence component at initial time of the norma! turning gait), and even this initial divergence component 
is not simply zero. When parameters of the normal gait change, the initial divergence component of the normal gait 
also changes. In short, an appropriate divergence component changes depending on the gait form such as a way of 
walking or running and the like. Therefore, in this embodiment, the normal gait following the current time gait to be 
generated from now is set in. accordance with the required parameters related to the current time gait After an initial 
divergence component of the norma! gait is obtained, the current time gait is generated so that an final divergence 
component of the current time gait coincides with the initial divergence component of the normal gait (more generally 
the current time gait is continued to or brought close to the normal gait). This basic guideline for such gait generation 
is similar to that in Patent Application No. 2000-352011 earlier proposed by the applicant. 

[0160] In the embodiments of this .invention, a linear dynamic model with three material particles like the one used 
in the first embodiment of Patent Application No. 2000-352011 is not used. However, concepts of a divergence com- ' 
ponent and a convergence component defined in the following equation can be applied to a perturbation of behavior 
of the nonlinear dynamic model like the model shown in Fig. 10, with approximately sufficient accuracy. 

Divergence component = body material particle's horizontal 

position 

+ body material particle's horizontal velocity/coO Equation 1 0 

Convergence component = body material particle's horizontal 

position 

- body material particle's horizontal velocity/coO Equation 1 1 

[01 61] Here, the body material particle's horizontal position represents the body material particle's horizontal position 
Xb in the foregoing dynamic model shown in Fig. 1 0. 

[01 62] Further, w0 is a predetermined value, and, for running, this value needs to be slightly changed from the value 
obtained when generating a walking gait in Patent Application No. 2000-352011 . 

[0163] Other details regarding the divergence component and convergence component are described in Patent Ap- 
plication No. 2000-352011 . Therefore, no further details are provided. 

[0164] In this embodiment, in addition to the method shown in Patent Application No. 2000-352011 , gait parameters 
defining the desired floor reaction force's vertical component trajectory are set and the total center-of-gravity vertical 
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position of the robot 1 is determined to dynamically satisfy the desired floor reaction force's vertical component as 
described later. In this case, the second-order Integral of the floor reaction force's vertical component defines the total 
center-of-gravity vertical position of the robot 1 . Therefore, if the desired floor reaction force's vertical component is 
badly set, the total center- of -gravity vertical position or the body vertical position of the robot 1 becomes too high or 

5 too low. Thus, a method of setting the desired floor reaction force's vertical component is also an important issue, 
However, the relation between the floor reaction force's vertical component and the body vertical position is similar to 
the relation between the ZMP and the body horizontal position. Therefore, a part of a determining meLhod of desired 
ZMP for realizing appropriate body horizontal position velocity is only slightly changed as shown in the following of this 
embodiment, and the changed determining method can be applied to a determining method of the desired floor reaction 

10 force's vertical component for realizing appropriate body vertical position/velocity. 

[0165] Turning backtothe main subject, in S022, the following processing is performed following the flowchart shown 
in Fig. 14. 

[0166] First of ail, in S100, among the gait parameters for the normal gait, the foot trajectory parameters are deter- 
mined so that the foot position/posture trajectories are continuous sequentially through the current time gait, the first 

15 turning gait, and the second turning gait. A specific setting method thereof is described below with reference to Fig. 
15. Note that, in the description below, the foot 22 of the ieg 2 on the supporting leg side is called a supporting leg foot, 
and the foot 2 of the leg 2 on the free leg side is called a free leg foot. Further, "beginning" and "end" of a gait means 
initial time and end time of the gait or instantaneous gaits at initial time and end time, respectively. 
[01 67] The foot trajectory parameters are configured by positions/postures of the supporting leg foot 22 and the free 

20 leg foot 22, respectively, at the beginnings and ends of the first turning gait and the second turning gait, and gait period 
of each turning gait and the like. Among the foot trajectory parameters, a free ieg foot position/posture at first turning 
gait's beginning is set to be a supporting leg foot position/posture at current time gait's end, viewed from the next time 
gait's supporting leg coordinate system. In this case, in the running gait, the supporting leg foot 22 at the end of the 
current time gait is moved in the air. The supporting leg foot position/posture at current time gait's end are obtained by 

25 generatingfoot position/posture trajectories from the supporting leg foot position/posture at current time gait's beginning 
( = f r ee ieg foot position/posture at lasttime gait's end) to free leg foot position/posture at next time gait's end (specifically, 
trajectories viewed from the next time gaifs supporting leg coordinate system), by the use of the foregoing finite duration 
settling filter until the end of the current time gait. The free ieg foot position/posture at next time gait's end is determined 
in accordance with either required values of the expected landing position/posture of the free leg foot 22 of the second 

30 step in the foregoing required parameters (required values of the expected landing position/posture of the current time 
gait's supporting leg foot 22, in the next time gait), or the next but one time gait's supporting leg coordinate system, 
corresponding to the required values. 

[0168] The free leg foot position/posture at next time gait's end are determined so that the position/posture of the 
foot 22 coincide with the position/posture of the next but one time gait's supporting leg coordinate system, when the 

35 foot 22 is rotated from the position/posture at next time gait's end by a predetermined angle in the pitch direction, so 
that the toe is lowered while contacting a floor, until the foot is horizontally postured. In other words, the free leg foot 
position/posture at next time gait's end are position/posture of the foot 22 in the following state. The foot 22 is rotated 
by a predetermined angle in the pitch direction from the required values of the landing position/posture of the free [eg 
foot 22 of the second step in the foregoing required parameters, so that the toe is lifted while the foot 22 contacts the 

40 floor without causing slip (a state where the toe is lifted and the heel lands). 

[0169] Further, supporting leg foot position/posture at the first turning gait's beginning are set to be free leg foot 
position/posture of current time gait's end viewed from the next time gait's supporting ieg coordinate system. In this 
case, as in the case of the free leg foot position/posture at next time gait's end, the free leg foot position/posture at 
current time gait's end is defined in accordance with the next time gait's supporting leg coordinate system orthe required 

45 values of the free ieg expected landing position/posture of the first step (current time gait) of the foregoing required 
parameters, corresponding to the next time gait's supporting leg coordinate system. In other words, the free leg foot 
position/posture at current time gait's end are determined so that the representative point of the foot coincides with the 
origin of the next time gait's supporting leg coordinate system, when the foot 22 is rotated to lower the toe while con- 
tacting the floor so that almost entire bottom surface of the foot 22 contacts the floor. 

50 [0170] Free leg foot position/posture at the first turning gait's end are determined based on the position/posture of 
the next but one time gait's supporting leg coordinate system , viewed from the next time gait's supporting leg coordinate 
system, as in the case of the determining methods for the free leg foot position/posture at current time gait's end and 
the free leg foot position/posture at next time gait's end. More specifically, the free leg foot position/posture at the first 
turning gait's end are set so that the foot position/posture coincide with the position/posture of the next but one time 

55 gait's supporting leg coordinate system, viewed from the next time gait's supporting leg coordinate system, when the 
foot 22 is rotated while contacting'the floor without slipping, by a predetermined angie from the position/posture at the 
first turning gait's end until the foot 22 is horizontally postured, 

[0171] At the end of the first turning gait, the supporting leg foot 22 is lifted in the air. In order to determine trajectories 
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after the supporting leg foot 22 is lifted, expected landing position/posture of the first turning gait supporting leg foot 
are set. The expected landing position/posture of the first turning gait supporting leg foot are set based on position/ 
posture of the next but two time gait's supporting leg coordinate system, viewed from the next time gait's supporting 
leg coordinate system. More specifically, the expected landing position/posture of the first turning gait supporting leg 

5 foot are the position/posture of the next but two time gait's supporting leg coordinate system, viewed from the next 
time gait's supporting leg coordinate system. Note that, the next but two time gait's supporting leg coordinate system 
is set such that a relative position/posture relation between next but one Lime gait's supporting leg coordinate system 
and the next but two time gait's supporting leg coordinate system coincides with a relative position/posture relation 
between the current time gait's supporting leg coordinate system and the next time gait's supporting leg coordinate 

10 system. 

[0172] As in the case of obtaining the supporting leg foot position/posture at the first turning gait's beginning, free 
leg foot position/posture at the first turning gait's end are obtained by generating foot position/posture trajectories (more 
specifically, trajectories viewed from the next time gait's supporting leg coordinate system) from the supporting leg foot 
position/posture at the first turning gait's beginning to the expected landing position/posture of the first turning gait 
15 supporting leg foot, by the use of the finite duration settling filter until the end of the first turning gait. 

[0173] Free leg foot position/posture at the second turning gait's beginning are set to be the supporting leg foot 
position/posture at the first turning gait's end viewed from the next but one time gait's supporting leg coordinate system. 
The supporting leg foot position/posture at the second turning gait's beginning are set to be the free leg foot position/ 
posture at the first turning gait's end viewed from the supporting leg coordinate system of the next but one time's gait. 
[0174] Free leg foot position/posture at the second turning. gait's end are set to be the free leg foot position/posture 
at the current time gait's end viewed from the current time gait's supporting leg coordinate system. Supporting leg foot 
position/posture at the second turning gait's end are set to be the supporting leg foot position/posture at current time 
gait's end viewed from the current time gait's supporting leg coordinate system. 

[0175] The gait periods of the first and second turning gaits are set to be the same as the next time'gait's periods. 
The gait periods of the first and second gaits do not always have to be the same. It is preferred, however, that any 
cycle is determined at least in accordance with the next time gait's period. Note that movement parameters (including 
time parameters such as the two-leg supporting period) other than those described earlier, for the current time gait, 
the first turning gait and the second turning gait are determined, as appropriate, to satisfy gait conditions (for example, 
whether velocities of actuators are within its allowable range, whether a movable angle is exceeded, and whether any 
30 interference with the floor or the like" exists). 

[0176] Next, processing proceeds to S102, in St 02, determined are reference body posture trajectory parameters 
defining a reference body posture trajectory that the desired body posture should follow. The reference body posture 
does not have to be a uniform posture as long as the reference body posture is set to be continuous at the beginning 
of the normal gait (beginning of the first turning gait) and the end of the same (end of the second turning gait) (so that 
35 posture angles of the reference body posture and angular velocities of these angles are the same at the beginning and 
end of the normal gait). In this embodiment, however, the reference body posture is set to be an upright posture (vertical 
posture) for easier understanding. In other words, in this embodiment, the reference body posture Is set to be the 
upright posture over the entire period of the normal gait. Therefore, in this embodiment, the angular velocity and angular 
acceleration of the posture angle of the reference body posture are zero. 
40 [0177] Next, processing proceeds to S104, where arm posture trajectory parameters are determined. More specifi- 
cally, determined are the arm posture trajectory parameters apart from those related to changes of angular momentum 
of both arms about the vertical axis (or body trunk axis). For example, determined are arm posture trajectory parameters 
for heights of the tips of hands of the arms, center of gravity of the entire arms relative to the body 24, and the like. In 
this embodiment, the center of gravity of the entire arms is set to be maintained at constant position relative to the body. 
45 [0178] Next, processing proceeds to S1 06, where floor reaction force's vertical component trajectory parameters are 
set. In this case, the floor reaction force's vertical component trajectory parameters are set so that the floor reaction 
force's vertical component trajectory defined by the parameters is substantially continuous as shown in Fig. 6 in any 
one of the first and second turning gaits. In other words; a desired floor reaction force's vertical component trajectory 
of the normal turning gait is set with a pattern shown in Fig. 16. In this pattern, in anyone of the first and second turning 
so gaits, the floor reaction force's vertical component is changed into a trapezoid shape during the one-leg supporting 
period, and the floor reaction force's vertical component is maintained at zero during the floating period. Times of break 
points and the height (peak value) of the trapezoid portion of the pattern are set as the floor reaction force's vertical 
component trajectory parameters. 

[0179] When setting the floor reaction force's vertical component trajectory parameters, an average value of the floor 
55 reaction force's vertical components overthe entire gait duration (period of both first and second turning gaits combined 
together; period of one cycle of the normal gait) is caused to coincide with the self weight of the robot 1 . In other words, 
the average value of the floor reaction force's vertical components is allowed to have the same magnitude as that of 
the gravity acting on the robot 1 in the opposite direction. 
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[0180] It is necessary to set the floor reaction force's vertical component trajectory in the above-described manner 
in order to satisfy a condition of the normal gait. The condition of the normal gait is that an initial state (initial state of 
the first turning gait) of any state variable (position, posture, velocity and the like of each portion of the robot 1) of the 
gait viewed from the supporting leg coordinate system (coordinate system set on the floor surface that the foot 22 on 

5 the supporting leg side contacts) is the same as the end state (end state of the second turning gait) of the gait viewed 
from the next supporting leg coordinate system (supporting leg coordinate system of the next first turning gait). (Here- 
inafter, this condition may be referred to as a boundary requirement of the normal gait). Therefore, a difference between 
the total center of gravity's vertical velocity of the robot 1 at the end of the normal gait and the total center of gravity's 
vertical velocity at the beginning of the normal gait (specifically, a difference between the total center of gravity's vertical 

10 velocity at the end of the second turning gait and the total center of gravity's vertical velocity at the beginning of the 
first turning gait) also has to be zero. The difference stated above is an integral (first-order integral) of a difference 
between the floor reaction force's vertical component and the gravity. Hence, in order to reduce the abovementioned 
difference into zero, it is required to set the floor reaction force's vertical component trajectory in the aforementioned 
manner. 

15 [0181] In this embodiment, average values of the floor reaction force's vertical components in individual periods of 
the first turning gait and the second turning gait are caused to coincide with the self weight of the robot 1 , respectively. 
To be more specific, for example, in each turning gait, times of break points of the trapezoid portion of the floor reaction 
force's vertical component trajectory is set, in accordance with the gait periods of the first and second turning gaits. 
Thereafter, the heights of the trapezoid portions are determined so that the average values of the floor reaction force's 

20 vertical components in individual periods of the first and second turning gaits coincide with the self weight of the robot 
1 , respectively. (Each height of the trapezoid is obtained by solving an expression expressing a condition to cause the 
above-mentioned average value to coincide with the self weight, where the height of the trapezoid is set to be unknown.) 
[0182] Accordingly, a difference between the total center of gravity's vertical velocity at the end of the first turning 
gait and the total center of gravity's vertical velocity at the beginning of the first turning gait becomes zero. A difference 

25 between the total center of gravity's vertical velocity at the end of the second turning gait and the total center of gravity's 
vertical velocity at the beginning of the second turning gait becomes also zero. However, this is not always required. 
For example, when the body vertical position seems about to become too high ortoo low around the boundary between 
the first and second turning, gaits, thus resulting in an improper posture, the height or the like of the trapezoid of the 
floor reaction force's vertical component of each turning gait may be corrected from the state where the aforementioned 

30 average value and the self weight are caused to coincide with each other in each turning gait. 

[0183] Next, processing proceeds to S108, where a allowable range of floor reaction force's horizontal component 
[Fxmin, Fxmax] (to be more specific, parameters defining allowable range) is set as shown in Fig. 17, in accordance 
with the floor reaction force's vertical component trajectory set as shown in Fig. 1 6 in the aforementioned manner. A 
broken tine on the negative side in Fig. 17 represents a floor reaction force's horizontal component allowable lower 

35 limit Fxmin, and a broken line on the positive side represents a floor reaction force's horizontal component allowable 
upper limit Fxmax. A supplementary description is provided below regarding a method of setting these limitations, In 
description given below is about a case where a floor surface is horizontal. 

[0184] The floor reaction force's horizontal component is generated by friction between a floor and the foot 22. How- 
ever, friction is not generated without limitation. There is a limitation of friction. Therefore, the floor reaction force's 
40 horizontal component of a desired gait always has to be within the friction limit, in order to prevent the actual robot 1 
from slipping when the actual robot 1 moves in accordance with the generated desired gait. In order to satisfy this 
condition, the floor reaction force's horizontal component allowable limit is set, and the desired gait is generated so 
that the floor reaction force's horizontal component of the desired gait remains within the allowable range as described 
later. 

45 [0185] Let a coefficient of friction between the floor and the foot 22 be jx. Fxmin then has to be always set equal to 
or greater than -ja*floor reaction force's vertical component, and Fxmax has to be set equal to or smaller than u.*floor 
reaction force's vertical component. The simplest setting method is setting by the following equations, where ka rep- 
resents a positive constant smaller than 1 . 

50 

Fxmin = -ka*Li*rloor reaction force's vertical component 

Fxmax = ka*u,*floor reaction force's vertical component Equations 1 2 

55 

[0186] The floor reaction force's horizontal component allowable limit in Fig. 17 is an example of the allowable range 
set in accordance with Equations 12. Values and time at break points of a trapezoid waveform in Fig. 17 may be set 
as parameters defining the floor reaction force's horizontal component allowable limit. However, when determining the 
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^Zl eaCti0 T rC f S h ° riZ ° ntal com P° nent allowable "m* by using Equations 12, the values of (ka*u) in Equations 12 
may be simply set as the parameters. ' ' H " s ,gi 

[0187] There is no problem to set the floor reaction force's horizontal component allowable limit by using other settina 
method, as long as the above condition (condition that the floor reaction force's horizontal component of th «S 
gait always remains within the frictional limit) is satisfied. Further, the floor reaction lorJs ZZZa clloTeTl 
lowable limit set in S1 08 is used for generating the normal gait for determining conditions at the end of he cTZl t me 
gaiti Therefore the floor reaction force's horizontal component allowable limit is not necessarily dete mine basec on 
a strict fnction limit. For example, the floor reaction force's horizontal component allowable L72K.^££ 

S T ^ 93 3 rangS eXC6eding friCti ° n ' imit The Same Can be said * floZg P eZ " 

[01 1 88] Next processing proceeds to S 1 1 0, where ZM P trajectory parameters are set. The ZM P trajectory parameters 

define a ZMP trajectory of the normal gait in which the first and second turning gaits are combined 7 tiTcTe the 

™Z M trajeC r ? tD StabMity mar9in n0t t0 Chan ^ e ^ « ^scTibLd eariie* ' *' 

[0189] More specifically, ,n the running gait in Fig. 5, the supporting leg foot 22 lands with its heel and a while later 
almost entire bottom surface of the supporting leg foot 22 contacts the floor. Another while later, only thete of he 
supporting leg foot 22 contacts the floor. Thereafter, the toe of the supporting leg foot 22 kicks the loor to jump into 
the air, and finally, the free leg foot 22 lands with its heel. In addition, the desired ZMP must be within the con aS 
surface. Therefore, ,n this embodiment, in each of the first and second turning gaits of the normal q^i the Position o 
the desired ZMP in the X-axis direction is set to remain the initial position, which is the poXn o t e heeTS the 
supporting leg foot 22, until almost entire bottom surface of the foot 22 contacts the floor, as shown in the upper d aaram 
m F,g. 7. Next the desired ZMP is set as follows. The desired ZMP moves to the center of the ^mfitoSSS 
and moves to the toe before the foot 22 comes into a state where the toe contacts the floor. Thereafter he ZMP stays 
at the toe of the supporting leg foot 22 until the foot 22 is lifted. In addition, after the above, the desired ZM P sea uent alv 
moves from the toe of the supporting leg foot 22 to a landing position of the heel of free le S 22 'by Z Sme 
next free leg oot 22 iands, as described earlier. Therefore, the desired ZM P trajectory (trajectory in the X 'axis d ection! 
of the norma, gait configured by the first and second turning gaits is as shown in Fig 18 Time and JosZs 
points of the desired ZMP trajectory are set as the ZMP trajectory parameters. In this case, time of tne break points 
set ,n accordance with gait periods of the first and second turning gaits defined by the e^Bm^^ZST^. 
rameters. The positions of the break points are set in accordance with the positions/postures o 'he nex Ze Ss 
supporting leg coordinate system and the next but one time gaits supporting leg coordinate system or requi S vaTues 
of the expected landing positions/postures of free leg foot on the first and second steps of the requl J Vetera 
defining the above coordinate systems.. The position of the ZM P trajectory in the Y-axis direction is set as in thTcase 
of the trajectory shown ,n the lower diagram in Fig. 7. More specifically, in the first turning gait, the trajectory oHhe 
desired ZMP at a position of the Y-axis direction is set to have the same pattern as that in the lower d agram in Rq 7 

loh hTTh tUm,nS f 9ait ' ° f th6 dSSired ZMP 9t a P° sition of the Y - a *' s dir -tion ,s set to beTt ajSony 
turning gait " °' "* tUmin9 ^ ^ " C ° ntinU ° US fr ° m the end of the ^«*°<V * ^firS 

[0190] Finally, processing proceeds to S112, where initial time, end time and period of one step (one cycle) of the 
normal gait are redefined as described below. y ' 

[0191] The normal gait must be a gait in which state variables at the beginning and end of the gait are sequentially 
•continuous. In this embodiment, differently from the foregoing definition of gait in a narrow sensed oeginn ing end 
and period of one step of the normal gait are defined as shown in Fig. 16 for convenience, until the no Zl gait is 
S " ° rder t0 determine this kind ° f ^ — 'n other words, in the latter half of the one-leg support ng 
period of the first turning gait, time at which the floor reaction force's vertical component is reduced to some exten is 

?J5 h f ^ n ° rmal * " Preferred th3t ' 93 Sh ° Wn in R 9- 7 ' the initial time Ts ^ set to oT a mtmlnt 

1 th^/f t C ° tln9 . P0rtiOn ° f SUPP ° rtin9 169 f ° 0t 22 Shifts from a,most entire bottom surface thereof to the 
oe thereo , or time immediately before the moment (end time of the whole sole contacting period in Fig 7 o time 
immediately before that). Further, a relation between the desired ZMP set In 8110 and time Ts shown in^ Fig 8^ 

m a aaftTedt a ' m ° St T ^ ^ SUPP ° rtin9 ^ f00t 22 contacts tha f'oorhfthe fi s 

n ,!' P m0VSS t0 the CSnter ° f the su PP° rtin 9 foot 22, and then to the toe by the time the toe 
contacts the floor. It ,s preferred that the moment that the desired ZM P moves to the toe be set as time Ts This in S 

ESL^T T ' n aC t CO t nCe With ' f ° r eXamP ' e ' the d6Sired 2MP tra ^ P™ ate - «* earfle T Trelson why he 
initial time Ts is set in the above manner is described later. V 

furnina aaHs ^ndWnTthL" ^ ^ TC *° ° f * he n ° rma ' gait iS the SUm of gait P eriods of the firat and second 

turning gaits. End time of the normal gait is represented by Te. Te is set to be time obtained by adding Tcyc to Ts 

S204 n pZT^^Tr f ^ n ° rma ' ^ iS determined ( a P oint ^ time of exit from a later-described loop of 

fn a narrow sense n T*il ^T 9, ■ I- " • ^ ° f 93it ^ Changed ba ° k t0 the ^mentioned definitions 
in a narrow sense. In the following description, initial time based on the definition of the gait in a narrow sense (time 

at wh,ch the supporting leg foot 22 begins to land) is represented by 0. The above mentioned initial time Ts, which is 
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used until the normal gait is determined, is discriminated from the original initial time 0 by using Reference Symbol Ts. 
(The initial time Ts is sometimes abbreviated as "Ts"). 

[0194] After the processing shown from S010 to S022 in Fig. 12 are performed, processing proceeds to S024, where 
initial states of the normal gait are calculated. The initial states calculated here are initial body horizontal position/ 
velocity (initial body position and initial body velocity in the horizontal direction), initial body vertical position/velocity 
(initial body position and initial body velocity in the vertical direction), an initial divergence component, an initial body 
posture angle and its angular velocity, of the normal gait. Calculation of the initial states is searchingly performed, 
following the flowchart in Fig, 19. 

[0195] In the flowchart in Fig. 19, first of all, in S200, initial states (states at initial time Ts) of desired foot position/ 
posture desired arm postures, and desired body posture angle (posture angle and direction) are determined based 
on the gait parameters of the normal gait (parameters set in S022 in Fig. 12). The "states" herein mean position and 
posture, as well as their rates of change (time differentials). 

[0196] In this case, the initial states of the desired foot position/posture on the supporting leg side are determined 
by generating foot position/posture trajectories (trajectories viewed from the next time gait's supporting leg coordinate 
system) from the supporting leg foot position/posture at firstturning gait's beginning to the free leg foot position/posture 
at the second turning gait's end, of the foot trajectory parameters determined in S100 in Fig. 14 described earlier. The 
foot position/posture trajectories are generated by the use of the finite duration settling filter, until time Ts. The initial 
states of the desired foot position/posture on the free leg side are determined by generating foot position/posture 
trajectories from the supporting leg foot position/posture at current time gait's beginning, viewed from the next time 
gait's supporting leg coordinate system, to the free leg foot position/posture at the first turning gait's end. The position/ 
posture trajectories are generated by the use of the finite duration settling filter until time Ts. Further, the initial states 
of the desired arm postures are determined by obtaining arm postures (total center of gravity or the like of both arms 
relative to the body 24) at timeTs, based on the arm posture trajectory parameters determined in S104 in Fig. 14. 
Furthermore the reference body posture (posture angle) and its angular velocity at time Ts, defined by the reference 
body posture trajectory parameters determined in S102 of Fig. 14, are determined as the initial state of the desired 
body posture angle. In this embodiment, since the reference body posture angle is the vertical posture, the initial state 
of the desired body posture angle (posture angle and its angular velocity) is zero. Moreover, in this embodiment, the 
desiredfoot position/posture trajectories, floor reaction force's vertical componenttrajectory, and desired ZMP trajectory 
of the normal gait are independently determined by the foot trajectory parameters, floor reaction force's vertical com- 
ponent trajectory parameters, and ZMP trajectory parameters determined in the flowchart in Fig. 1 4, respectively. For 
example the desired foot position/posture at each instance of the normal gait are determined in accordance with the 
foottrajectory parameters without depending on an instantaneous value of the floor reaction force's vertical component. 
[0197] Next in S202 candidates of initial body horizontal position/velocity (that is, candidate body horizontal position/ 
velocity at initial time Ts) expressed by (Xs, Vxs) (Xs: horizontal position, Vxs: horizontal velocity) are provisionally 
determined. The provisionally determined candidates (Xs, Vxs) may be arbitrary. However, for example, it is sufficient 
that the body horizontal position/velocity in the initial states of the normal gait, obtained when generating the last time 
gait, are the provisional candidates (Xs, Vxs). 

[0198] In orderto simplify description, an example will be given regarding a case of searching the initial states of the 
normal gait in the X direction (front-and-back direction) on the sagittal plane. In practice, however, it is required to 
separately or simultaneously search the initial states of the normal gait (initial states satisfying the foregoing boundary 
requirement of the normal gait) in the X direction (front-and-back direction) and Y direction (right-and-left direction) for 
both position and velocity. 

[0199] A searching decision method may be as follows. Affinite Jacobian (sensitivity matrix) is obtained and the next 
candidate is determined by a steepest-descent method. Alternatively, a simplex method can be used. In this embodi- 
ment, the steepest-descent method is used. 

[0200] Next, after S204, in S206, initial body vertical position/velocity (at timeTs) (Zs, Vzs) (Zs: vertical position, Vzs: 
vertical velocity) are determined. 

[0201] In this embodiment, the initial body vertical velocity Vzs is analytically determined in a manner below. 
[0202] The following equation holds true for the robot 1 , as a dynamic relation. 

Final total center-of-gravity vertical position - initial total 

center-of-gravity vertical position 
= second-order integral of (floor reaction force's vertical 

component / total mass of robot) 
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+ second-order integral of gravity acceleration 
+ initial total center of gravity's vertical velocity * duration 

ofoneste P . Equation 13 

(where gravity acceleration is a negative value) 

[0203] In the normal gait, the final total center-of-gravity vertical position and initial total center-of-qravity vertical 
position coincides with each other Thus, the right side of Equation 13 above has to be zero. Therefore the initial total 
center of gravity's vertical velocity can be obtained from this relation. Specifically, first of all, the floor reaction forco's 
vertical component calculated by the floor reaction force's vertical component parameters set in S1 04 in Fia 14 de- 
scribed earlier is divided by the total mass of the robot 1 . The resulting value is then second-order integrated for a 
period of one step (from time Ts to time Te). Thus, a total center of gravity movement amount by the fioor reaction 
force s vertical component (the first term on the right side of Expression 13) can be obtained. Further a gravity accel- 
eration is second-order integrated for a period of one step, thus obtaining a total center of gravity movement amount 
by the gravity (the second term on the right side of Equation 1 3). Thereafter, the sign of the sum of the total center of 
gravity movement amount by the floor reaction force and the total center of gravity movement amount by the gravity 
is changed, and the resulting value is divided by the duration of one step (duration of one cycle Tcyc of the normal 
gait), thus obtaining the initial total center of gravity's vertical velocity J 
[0204] Next, In order to obtain the initial body vertical position Zs, the total center of gravity's vertical velocity at time 
0 is obtained by the use of the following equation . At this time, a value obtained in the above manner based on Equation 
13 is substituted for the total center of gravity's vertical velocity at time Ts in the following equation; and integration 
period is set to be from time 0 to time Ts. y^uuM 



Total center of gravity's vertical velocity at time Ts - total 
center of gravity's vertical velocity at time 0 

30 

= first-order integration of (floor reaction force's vertical 
component/total mass of robot) 
35 + first-order integration of gravity acceleration Equation 14 

(where gravity acceleration is a negative value) 

[0205] Next, a body height (body vertical position) at time 0 (that is, at landing moment) is determined by the use of 
the body height decision method earlier proposed by the applicant in Japanese Patent Laid-Open Publication No 
40 He.se. 1 0-86080. At this time, the body vertical position (height of the body), at which the knees of both legs 2 and 2 
are not completely stretched at time 0, is determined based on the foot position/posture at time 0 (the supporting leq 
foot pos.tion/posture at the first turning gait's beginning (time 0) and the free leg foot position/posture at the first turning 
gatts begmnmg (t.meO) determined in S1 00 of Fig. 14 stated earlier), and predetermined geometric conditions regard- 
ing the bending angle of the knee of each leg 2. Specifically, when the knee bending angle of the leg 2 on the support™ 

leg 2 on the free leg side is represented bv Gswa 
the body vertical posit.on is determined so that, for example, the sum of inverse numbers of the sines of the knee 
bend.ng angles Osup and Gswg become predetermined values (finite values). Each of the knee bending angles 6sup 
and Oswg is an angle of the axis of thecrus portion with respect to the axis of the thigh portion of each leg 2 This anqle 
mcreases from zero as the knee bends from a state where each leg 2 is completely stretched. This method of deter- 
so mining the vertical position of the body 24 is detailed in Japanese Patent Laid-Open Publication No. Heisei 10-86080 
mentioned above. Thus description of the above is ended. 

[0206] Next, based on the body vertical position and the foot position/posture at time 0 determined in the above 
manner, the total center-of-gravity vertical position at time 0 is obtained using a model of the robot 1 . For example the 
-« T center-of-gravity vertical position at time 0 is obtained by using a kinematics model of earlier-described Equation 
°4 which corresponds to the model in Fig. 1 0. Specifically, the vertical position of the body material particle 24m is 
obtained from the body vertical position and body posture angle (which is zero in this embodiment) at time 0 The 
vertical positions of the supporting leg material particle 2m and free leg material particle 2m are obtained from the 
supporting leg foot position/posture and free leg foot position/posture at time 0 (which are the supporting leg foot 
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position/posture at the first turning gait's beginning andfree leg foot position/posture at the first turning gait's beginning, 
set in S100 of Fig 14 stated earlier), respectively. The vertical positions of the body material particle 24m, supporting 
leg material particle 2m and free leg material particle 2m are substituted for Zb, Zsup and Zswg of earlier-described 
Equation 04, respectively. Thus, the total center-of-gravity vertical position (ZGtotai in Equation 04) is obtained. Note 
that the total center-of-gravity vertical position at time 0 may also be obtained using a more precise model of the robot 
1 (for example, a model with multiple material particles as shown in Fig. 11), considering the body horizontal position 

and arm- positions at time 0. 1 
[0207] Next in expression 1 3, the total center- of- gravity vertical position at time 0 obtained above is substituted for 
the initial total center-of-gravity vertical position in the left side of Equation 1 3, and the total center of gravity's vertical 
velocity at time 0 obtained earlier is substituted for the initial total center of gravity's vertical velocity on the right side 
of Equation 13. in addition, duration of one step in Equation 13 is set to be Ts so that the integration period is from 
time 0 to time Ts. Thus, the value of final total center-of-gravity vertical position on the left side of Equation 13 is 
calculated and the calculated value is obtained as the initial total center-of-gravity vertical position (at time Ts). Further, 
the initial body vertical position Zs (at time Ts) is obtained by the use of a model of the robot 1 (for example, the 
kinematics model of Equation 04), from the initial total center-of-gravity vertical position (at time Ts) obtained as above, 
foot position/posture at time Ts (obtained in S200) and the like. Specifically, the vertical positions of the supporting leg 
material particle 2m and free leg material particle 2m of the model in Fig. 1 0 are obtained from the foot position/posture 
of each of the supporting leg and free leg at time Ts. These vertical positions and the Initial total center- of- gravity vertical 
position (at time Ts) obtained earlier are applied to Equation 04, thus obtaining the vertical position of the body material 
particle 24m (Zb in Equation 04). From the vertical position of the body material particle 24m and the body posture at 
time Ts (which is zero in this embodiment), the initial body vertical position Zs (at time Ts) is obtained by reverse 
calculation. In this case, the initial body vertical position Zs may also be obtained by using a more precise model, 
considering the body horizontal position and arm postures. 

[0208] Finally, the initial body vertical velocity is obtained using a model of the robot 1 (for example, the kinematics 
model of Equation 04), from the initial states of foot position/posture determined in foregoing S200, the initial total 
center of gravity's vertical velocity obtained in S206, and the like. Specifically, the initial total center of gravity's vertical 
velocity obtained based on foregoing Equation 13 and the vertical velocities of supporting leg materia! particle 2m and 
free leg material particle 2m defined by the initial state of foot position/posture on each of the supporting leg side and 
free leg side are applied to an equation obtained by differentiating both sides of Equation 04 with respect to time. Thus, 
the vertical velocity of the body material particle 22m is obtained. Thereafter, the body vertical velocity is obtained from 
the vertical velocity of body material particle 22m and the initial state of body posture angle (determined in S200 or 
S208 described later). Note that, the initial body vertical velocity satisfying the initial total center of gravity's vertical 
velocity obtained above may also be obtained by the use of a more precise model of the robot 1 , considering not only, 
the initial states of each foot position/posture and initial total center of gravity's vertical velocity, but also the initial states 
of arm postures (determined in S200), the provisionally determined initial state of body horizontal position (latest one 
that is provisionally determined in S202 or later described S216 or S21 8), and the initial body vertical position obtained 

above. , 
[0209] Supplementarily, the robot 1 has six degrees of freedom for each leg. Thus, even if the model of the robot 1 
is complicated (rigorous) as the one shown in Fig. 11 , all initial states of the robot are uniquely determined if initial 
states of the foot position/posture trajectories and the body position/posture trajectories (position/posture and their 
rates of change) are given. Therefore, if they are given, the initial total center of gravity's vertical velocity is uniquely 
determined as well. On the other hand, since there are six degrees of freedom for each leg, even if one of the velocity- 
related states (for example, the initial body vertical velocity) among the initial states of the foot position/posture trajec- 
tories and the body position/posture trajectories is undetermined, the undetermined initial state is uniquely determined 
if the initial total center of gravity's vertical velocity is given. 

[0210] After the processing of S206, processing proceeds to S208, where the normal turning gait is provisionally 
generated More specifically, based on the gait parameters of the normal gait determined in S022 in Fig. 1 2 mentioned 
earlier desired ZMP, desired floor reaction force's vertical component, desired foot position/posture, reference body 
posture desired arm postures and floor reaction force's horizontal component allowable limit, at each instance from 
the initial time Ts to end time Te, are sequentially obtained. Thereafter, the aforementioned body horizontal position/ 
velocity (Xs and Vxs) and body vertical position/velocity (Zs, Vzs) are set as the initial states of the body 24 (at time 
Ts) The body position/posture are then sequentially determined by the use of the foregoing dynamic model (model in 
Fig 10) so as to satisfy dynamic equilibrium conditions related to the desired ZMP and desired floor reaction force's 
vertical component obtained above, and conditions of the floor reaction force's horizontal component allowable limit. 
Thus, the gait from time Ts to end time Te is generated. At this time, the gait is generated so that the body posture 
coincides with the reference body posture as much as possible. 

[021 1 ] Note that, this gait generation for the normal gait is performed within the gait generating device 1 00 only. The 
normal gait is not outputted to the foregoing composite-compliance operation determinator 104 as desired values for 
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driving the actual robot 1 . 

[0212] Hereinbelow, details are given regarding processing in S208, which is normal gait generation processinq bv 
consecutive calculation. y y 

[021 3] Fig. 20 is a subroutine flowchart showing this processing. 

[0214] Description is as follows. In S300, various initialization is performed. Specifically, the initial time Ts is substi- 
tuted for time for provisional gail generation k. Furlher, provisionally determined current (Xs, Vxs) (determined in S202 
or later described S21 6 or S21 8 in Fig. 1 9) are substituted for the body horizontal position/velocity The latest (Zs Vzs) 
obtained in foregoing S206 are substituted forthe body vertical position velocity. Moreover, the initial value of reference 
body posture angle (reference body posture angle at time Ts) is substituted for the desired body posture angle and 
the initial value of reference body posture angular velocity (reference body posture angular velocity at time Ts) is 
substituted forthe desired body posture angular velocity. Supplementarily, since the initial desired body posture anqular 
velocity is ultimately changed as described later, it is possible to substitute a value different from the initial value of 
reference body posture angular velocity. 

[0215] Next, in S304 after S302, it is determined whether or not time for provisional gait generation k is before end 
time of gait (whether or not k< Ts + Tcyc). If the determination result is YES, processing proceeds to gait instantaneous 
value decision subroutine in S306, where gait instantaneous values are determined. Next, the processinq of the qait 

generating device 100 proceedsto S308, wheretimeforprovisional gaitgeneration kis increased by Ak andprocessinq 
then returns to S304. K y 

[0216] Here, Ak is an interval of provisional gait generation, and usually,' it is sufficient that Ak coincides with control 
cycle At. If dynamic accuracy of the provisional gait can be reduced, Ak may be set longer than At in order to reduce 
the amount of calculation. 

[0217] When the determination result in S304 is NO, processing proceeds to S310. By the processing described 
above, the normal gait is generated from the beginning to the end thereof before processing proceeds to S31 0 
toF 1 ig l 21 HereinbelOW ' detailS ° fthe 9ait instantaneous value declsion subroutine in S306 are described with reference 

[0219] First of all, in S400 in Fig. 21 , a value (present value) at time k of the desired floor reaction force's vertical 
. component shown in Fig. 1 6 described earlier is obtained based on the normal gait parameters (floor reaction force's 
vertical component trajectory parameters). Moreover, in S402, a value (present value) at time k of the desired ZMP 
shown in Fig. 18 described earlier is obtained based on the normal gait parameters (ZMP trajectory parameters) 

so [0220] Next, processing proceeds to S404, where values (present values) of desired both foot positions/postures 
(desired foot postures/positions on both supporting leg side and free leg side), reference body posture and desired 
arm postures at t.me k are obtained based on the normal gait parameters (foot trajectory parameters, reference body 
posture trajectory parameters, and arm posture trajectory parameters). To be specific, as for the desired arm postures 
total center of gravity of both arms is determined, but movements of the arms (arm swinging movements) for chanqinq 

35 angular momentum about the vertical axis (or body trunk axis) are not yet determined. Note that, the present values ' 
(values at t.me k) of the desired foot position/posture are obtained as in the case where the foot position/posture was 
obtained at initial time Ts in S200 in Fig. 1 9 described earlier. 

[0221] Next, processing proceed to S406, where values (present values) of total center-of-gravity vertical position/ 
velocity at time k are calculated to satisfy the desired floor reaction force's vertical component (to cause the sum of an 
40 mertiai foroe and gravity in the vertical direction of the robot 1 to balance with the desired floor reaction force's vertical 
component). Specifically, for example, the total center-of-gravity vertical position/velocity is calculated based on fore- 
going Equations 01 and 04 related to the dynamic model in Fig. 10 described earlier. In other words according to 
Equat.ons 01 and 04, obtained is a relational expression (equation of movement related to the total center of gravity 
of the robot 1 in the vertical direction) expressing that a value obtained by multiplying the sum of the total center of 
gravity s vertical acceleration and gravity acceleration by a movement of the robot 1 , by the total mass of the robot 1 
is equal to the floor reaction force's vertical component. Therefore, the total center of gravity's vertical acceleration Is 
obtained from this relational expression and the desired floor reaction force's vertical component 
[0222] Note that this relational expression itself is generally established without depending on the model of the robot 
1 . By integrating the obtained total center of gravity's vertical acceleration, a total center of gravity's vertical velocity is 
calculated. Further, by integrating the total center of gravity's vertical velocity, a total center-of-gravity vertical position 
is calculated. More generally, these calculations are performed by dynamic relational expressions (equations obtained 
by discretizing Newton's equation of movement) expressed by the following Equations 15 and 16. 

55 Total center of gravity's vertical velocity at time k 

- total center of gravity's vertical velocity at time (k-Ak) 



31 

5NSDOCID: <EP_.__ 14751 98A1 I > 



EP 1 475 198 A1 



10 



+ ( (floor reaction, force's vertical component/total mass of robot) 

+ gravity acceleration)* Ak 
(where gravity acceleration is a negative value) Equation 15 

Total center-of-gravity vertical position at time k 
= total center-of-gravity vertical position at time (k-Ak). 
+■ total center of gravity's vertical velocity at time k* Ak Equation 1 6 

15 [0223] Next, processing proceeds to S408, where a body vertical position satisfying the total center-of-gravity vertical 
position is calculated. Specifically, for example, the body vertical position is calculated by the use of Equation 04 related 
to the model in Fig. 10 described above. In other words, vertical positions of the supporting leg material particle 2m 
and free leg material particle 2m of the model in Fig. 10 are obtained from the present values of the desired foot 
positions/postures on the supporting leg side and free leg side. Thereafter, the vertical positions of the supporting leg 

20 material particle 2m and free leg material particle 2m obtained above and the present value of the total center-of-gravity 
vertical position obtained in S407 are applied to Equation 04, thus obtaining a vertical position of the body material 
particle 24m Further the body vertical position is obtained from the vertical position of the body material particle 24m 
obtained above and the present value of the desired body posture angle (reference body posture angle set in S404 or 
a desired body posture angle at the last time (time k-Ak), determined in later-described S414). 

25 [0224] Note that the body vertical position may be obtained by the use of a more precise model (for example, a 
model with multiple material particles as shown in Fig. 11 , having material particles corresponding to respective links 
of the robot 1). in this case, the body vertical position is obtained so that the present value of the total center-of-gravity 
vertical position obtained earlier coincides with a total center-of-gravity vertical position determined from the earlier- 
obtained present values (values at time k) of the desired both foot positions/postures, desired body posture at time (k- 

30 Ak) (or the present value of the reference body posture obtained earlier), the present values of desired arm postures 
(center of gravity of both arms), the body horizontal position at time (k-Ak), and the body vertical position desired to 
be obtained. 

[0225] In this case, the body posture and body horizontal position at time k are not yet determined, and the values 
of them at time (k-Ak) are used instead. In order to improve accuracy, estimated values at time k maybe obtained from 

35 a state of gait at time (k-Ak) by extrapolation. 

[0226] Next processing proceeds to S41 0, where values (present values) at time k of the floor reaction force s hor- 
izontal component allowable limit [Fxmin, Fxmax] shown in Fig. 1 7 are obtained based on the gait parameters (param- 
eters defining the floor reaction force's horizontal component allowable limit of the normal gait) determined in S108 in 
Fig. 14 described earlier. 

40 [0227] Next, processing proceeds to S41 2, where present values of body horizontal acceleration and body posture 
■ angular acceleration are determined to satisfy a dynamic equilibrium condition with respect to the desired ZMP (that 
a horizontal component of a moment generated about a desired ZMP by the resultant force of the inertial force and 
gravity of the robot 1 is zero). The body horizontal acceleration and body posture angular acceleration are determined 
so that the floor reaction force's horizontal component Fx does not exceed [Fxmin, Fxmax], and the body posture 

45 angular acceleration is the same at the beginning and end of the normal gait. Details of this are given hereinbelow. 
[0228] At this point, instantaneous values (present values) of the foot position/posture and body vertical position are 
determined as described earlier. Therefore, when remaining body horizontal position and body posture angle are de- 
termined a desired movement of the robot 1 can be uniquely determined, except for degree of freedom of movements 
of the arms which changes angular momentum about the vertical axis. Therefore, once the body horizontal position 

so and body posture angle are determined, all floor reaction forces are uniquely determined, except for a moment about 
the vertical axis of the floor reaction force. Note that, in this embodiment, the desired floor reaction force's vertical 
component and desired ZMP of the normal gait are respectively defined by the floor reaction force's vertical component 
trajectory parameters and desired ZMP trajectory parameters determined in S022 in Fig. 12 described earlier. Hence, 
the floor reaction force determined dependently on decision of the body horizontal position and body posture angle is 

55 the floor reaction force's horizontal component only. Further and supplementary, since each leg has six degrees of 
freedom in the robot 1 as mentioned earlier, position/posture of each portion of the leg 2 are uniquely determined from 
the desired foot position/posture and desired body position/posture. Note that, freedom of movement of the arms, 
which changes angular momentum about the vertical axis, is used for canceling a spin force as described later. 
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[0229] Incidentally, If the body rotation mode is mainly used and the foregoing body translation mode is not used so 
much when generating a gait in order to satisfy the desired ZM P (to cause the horizontal component of the fioor reaction 
force's moment about the desired ZM P to be zero), the body posture angle may change too much. Therefore, in order 
to prevent this, the body translation mode should be used as preferentially as possible. However, the body translation 
mode causes changes of the floor reaction force's horizontal component. Therefore, if the body translation mode is 
strongly applied and the Door reaction force's horizontal component allowable limit is narrow, the robot may slip. In 
such a case, there is no choice but to rely on the body rotation mode. During a period when the floor reaction force's 
horizontal component allowable limit becomes zero like the foregoing running gait, it is not feasible to generate a gait 
which generates the floor reaction force's horizontal component. Thus, there is no choice but to rely on the body rotation 
mode. In this embodiment, the body horizontal acceleration and body posture angular acceleration are determined 
considering the above, following the flowchart shown in Fig. 22. 

[0230] First of all, in S500, time Tm is set, at which the floor reaction force's vertical component is increased to a 
predetermined magnitude in the second turning gait, after the initial time Ts and then the floating period of the first 
turning gait. Further, time Ts2 is set, at which the floor reaction force's vertical component is decreased to some extent 
in the latter half of the one-leg supporting period in the second turning gait. Furthermore, time Tm2 is set, at which the 
floor reaction force's vertical component is increased to a predetermined magnitude in the first turning gait, after the 
floating period of the second turning gait. 

[0231] These times are shown in Fig. 16. It is preferred that time Tm be set as a moment at which almost entire 
bottom surface of the supporting leg foot 22 contacts the floor or a moment immediately after that moment. The same 
can be said of time Tm2 as well. It is also preferred that, as in the case of the foregoing initial time Ts, time Ts2 be set 
as a moment at which the floor contacting portion of the foot 22 shifts from almost entire bottom surface to the toe or 
a moment immediately before that moment. 

[0232] Moreover, description is given regarding relations between the desired ZMP in Fig. 18 set in S110 in Fig 14 
described earlier and times Tm, Ts2 and Tm2. It is preferred that time Tm be set as a moment at which the desired 
ZMP starts moving to the center of the supporting leg foot 22 in the second turning gait, after the desired ZMP remains 
at the initial position, the position of the heel of the supporting leg foot 22, until almost entire bottom surface of the foot 
22 contacts the floor, it is preferred that time Ts2 then be set as a moment at which the desired ZMP stops moving at 
the toe of the supporting leg foot 22 by the time only the toe contacts the floor. It is preferred that time Tm2 be set as 
a moment at which the desired ZMP starts moving to the center of the supporting leg foot 22 in the next first turning 
gait, after the desired ZMP remains at the initial position, the position of the heel of the supporting leg foot 22, until 
almost entire bottom surface of the foot 22 contacts the floor. 
[0233] The reason why they are set as above is described later. 

[0234] Next, in S502, it is determined whether or not current time (value of a timer for normal gait generation) k is 
between times Ts and Tm ortimes Ts2 and Tm2. If the determination result is YES, processing proceeds to S504, and 
35 if the result is NO, processing proceeds to S518. 

[0235] In S504, body horizontal acceleration atmp is obtained from a state of last instantaneous gait of the robot 1 
(state of gait at time k-1 ). This body horizontal acceleration atmp is required to satisfy the desired ZMP at present time 
(time k) if the angular velocity of the body rotation mode is set to be zero and the robot 1 is caused to perform a 
movement in the body translation mode. This atmp can be obtained by the use of, for example, foregoing Equation 03 
related to the dynamic model in Fig. 1 0 described earlier. More specifically, for example, the vertical accelerations of 
the supporting .leg material particle 2m and free leg material particle 2m are obtained by the use of time series values 
of the desired foot position/posture obtained by the current time k. At the same time, the vertical positions of the 
supporting leg material particle 2m and free leg material particle 2m are obtained by the use of the desired foot position/ 
posture at the current time k (present time). Further, the vertical position of the body material particle 24m is obtained 
by the use of the floor reaction force's vertical position at the current time k (present time), and the vertical acceleration 
of the body material particle 24m at the current time k is obtained by the use of time series values of the desired body 
vertical position obtained by the current time k. An equation is obtained by substituting these values obtained above 
into Equation 03 and letting My and d26by/dt2 in Equation 03 be zero. By solving this equation for d2Xb/dt2, the body 
material particle horizontal acceleration d2Xb/dt2 is obtained as the body horizontal acceleration atmp. A more precise 
model may be used to searchingly obtain the body horizontal acceleration atmp by which the horizontal component of 
the floor reaction force's moment about the desired ZMP becomes zero. Moreover, in this embodiment, the reference 
body posture is a vertical posture and the body posture angular acceleration by the reference body posture is thus 
zero. Therefore, the angular acceleration of the body rotation mode is set to be zero when the body horizontal accel- 
eration atmp is obtained. When the reference body posture trajectory parameters are set to change the reference body 
posture, and the reference body posture angular acceleration at the current time k, defined by the above parameters, 
is thus not zero, it is sufficient that the angular acceleration of the body rotation mode is set to be the value of the 
reference body posture angular acceleration, which is not zero, and that the body horizontal acceleration atmp is 
obtained by using the dynamic model. (For example, d29by/dt2 in Equation 03 is set to be the reference body posture 



30 



40 



45 



50 



55 



33 



3NSDOC1D: <EP 



14751 98A1_I_> 



EP 1 475 198 A1 

angular acceleration, which is not zero, and the body horizontal acceleration atmp is obtained in a manner similar to 
the manner described earlier) 

[0236] Next, processing proceeds to S506, where a floor reaction force's horizontal component Fxtmp at time k in a 
case where the body horizontal acceleration is atmp is obtained by using the dynamic model. In this embodiment, 
5 Fxtmp is obtained by the use of Equation 02 of the aforementioned dynamic model. In other words, Fxtmp is obtained 
by the following Equation 1 7, where d2Xsup/dl2 and d2Xswg/dl2 represent supporting leg foot material particle's hor- 
izontal acceleration and free leg foot material panicle's horizontal acceleration at the time k, respectively. 
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Fxtmp - mb*atmp + msup*d2Xsup/dt2 

• + mswg*d2Xswg/dt2 Equation 17 



[0237] An example of Fxtmp obtained as above is shown in Fig. 23. Portions where Fxtmp exceeds the floor reaction 
15 force's horizontal component allowable limit [Fxmin, Fxmax] are shaded in Fig. 23. 

[0238] Next, processing proceeds to S508, and body horizontal acceleration a of the body translation mode, a floor 
reaction force's horizontal component Fx generated by a, and a body angular acceleration p of the body rotation mode 
are determined as follows (S508 to S51 6). 

Specifically, ... 
20 if Fxtmp > Fxmax is established, processing proceeds to S51 0, and Fx is determined by the following equation. 

■r 

Fx = Fxmax Equation 18 

25 If Fxtmp < Fxmin is established, processing proceeds to S512, and Fx is determined by the following equation. 

Fx = Fxmin ' Equation 19 

so • in the other case, that is, if Fxtmp exists within the floor reaction force's horizontal component allowable limit [Fxmin, 
Fxmax], processing proceeds to S514, and Fx is determined by the following equation. 

Fx = Fxtmp Equation 20 



[0239] In any of the above cases, processing proceeds to S51 6, where the body horizontal acceleration a and body 
posture angular acceleration p are determined by following equations. 

a = atmp + (Fx - Fxtmp)/AFp Equation 21 

p = (atmp - a)*AMp/AMr Equation 22 

45 [0240] AFp, AMp and AMr are determined by Equations 06, 07, and 09, respectively. 

[0241] Supplementarily, in order to improve accuracy of dynamiccalculatipn.it is favorable that, after the body angular 
acceleration p is obtained in the above manner, the body horizontal acceleration a of the body translation mode be 
analytically or searchingiy determined by the use of a more rigorous dynamic model so that a movement, obtained by 
combining the body translation mode and body rotation mode producing the body angular acceleration p obtained 

50 above satisfies the desired ZMP. A searching decision method may be as follows: determining the next candidate by 
pseudo-Newton's method and the like after obtaining Affine-Jacobian (sensitivity matrix). A simplex. method and the 
like can be used instead. 

[0242] Moreover, in order to strictly prevent the fioor reaction force's horizontal component Fx from exceeding the 
floor reaction force's horizontal component allowable limit [Fxmin, Fxmax], a group of the body horizontal acceleration 
55 a and body angular acceleration p may be searchingiy obtained so that Fx becomes equal to Fxmax and the horizontal 
component of the floor reaction force's moment about the desired ZMP becomes zero in S510, and that Fx becomes 
equal to Fxmin and the horizontal component of the floor. reaction force's moment about the desired ZMP becomes 
zero in S512.' 



34 



nnrM-vi-\/->irv. -t - n 



^ a~7C*{ no A -i 1 -~ 



10 



15 



EP 1 475 198 A1 

[0243] Fx obtained as above is shown in Fig. 24. Fx is obtained by limiting (saturating) the value of Fxtmp so that 
Fxtrnp does not exceed the floor reaction force's horizontal component allowable limit [Fxmin, Fxmax] More specifically 
when Fxtmp according to the body horizontal acceleration atmp generated only by the body translation mode is within 
the allowable range [Fxmin, Fxmax], Fxtmp becomes Fx as it is. When Fxtmp according to the body horizontal accel- 
eration atmp generated only by the body translation mode is beyond the upper limit or lower than the lower limit of the 
allowable range [Fxmin, Fxmax], Fx is forcefully limited to be Fxmax or Fxmin. In Particular, in the floating period of 
the running gait, Fxmax = Fxmin = 0 is always applied, resulting in Fx = 0. 

[0244] The body posture angular acceleration B obtained as described earlier is shown in Fig 25 In order to prevent 
Fx, generated by the body translation mode, from exceeding the allowable range [Fxmin, Fxmax], the acceleration of 
the body translation mode is limited. A floor reaction force's moment, which becomes insufficient due to this limitation 
of acceleration of the body translation mode (more specifically, a moment obtained by subtracting a moment component 
generated by the limited body horizontal movement and movements of both legs 2 and 2 from the inertial force's 
moment required for causing the horizontal component of the floor reaction force's moment about the desired ZMP to 
be zero), is compensated by the body rotation mode. In the floating period of the running gait, the body horizontal 
acceleration a generated by the body translation mode is always limited to zero. Thus, the above-mentioned insufficient 
floor reaction force's moment is compensated only by the body posture angular acceleration B generated by the body 
rotation mode. ' ' 

[0245] The description provided above was about the processing when time k is between times Ts and Tm or between 
times Ts2 and Tm2. 

[0246] When the determination result in S502 is NO, the following processing is performed. First of all, processinq 
proceeds to S518. Set in S51 8 is a pattern of a ZMP-converted value of a floor reaction force's moment for generating 
the body posture angular acceleration for returning the body posture angular velocity to the initial value (hereinafter 
referred to as body posture restoring moment ZMP-converted value, and abbreviated as ZMPrec) (the value at time 
Ts if the current time k is before time Ts2, orthe value at time Ts2 if otherwise) by time Ts2 if the current time k is before 
25 time Ts2, or by time Te if otherwise. 

[0247] This is detailed below. Processing when the current time k is after the time Tm2 is similar to that when the 
current time k is before time Ts2. Thus, description is given only about the processing when the current time K is before 
time Ts2. 

[0248] Now, consider that the body posture angular velocity is retuned to its initial value (value at time Ts) by gen- 
erating the body posture angular acceleration using the body rotation mode, from the time Tm to time Ts2 A body 
posture angular acceleration pattern is therefore set as B(k). 

[0249] In body rotation mode, when attempting to generate the body posture angular acceleration B (k) a floor re- 
action force's moment B(k)*AMr is generated. If a floor reaction force's vertical component at the moment is Fz(k) a 
ZMP(k) calculated from the movement (not the desired ZMP) consequently shifts by AZMP obtained by thefollowina 
35 equation. 3 

t 

AZMP(k) = -0(k)*AMr/Fz(k) Equation 23 
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[0250] Thus, if the patterns of AMr and Fz(k) are determined (known), the body posture angular acceleration pattern 
satisfying Equation 23 is generated by setting the pattern of AZMP(k) as appropriate. Thus, the body posture angular 
velocrty can be returned to the initial value (value at time Ts), that is, the body posture angular velocity in the initial 
state of the reference body posture trajectory (at time Ts). 

[0251] The body posture restoring moment ZMP-converted value (ZMPrec) mentioned above means AZMP(k) ap- 
propriately set as above. Strictly speaking, AMr varies when setting the body posture restoring moment ZMP-converted 
value using the equation 23. However, AMr may be approximately set to as a constant value when setting the body 
posture restoring moment ZMP-converted value. This is because dynamic accuracy of the normal gait does not have 
to be so high since the normal gait is generated only provisionally, and the actual robot is not caused to follow the 
normal gait. 

[0252] Fig. 26 shows an example of ZMPrec. In Fig. 26, the pattern of the ZMPrec is set to be a trapezoid pattern 
The times at break points of the trapezoid portion correspond to the times at break points of the desired ZMP pattern 
(see Fig. 18) during the period between timeTm and time Ts2. This is because the desired ZMP pattern of the current 
time gait is easily corrected, as described later. By substituting ZMPrec for AZMP(k) in Equation 23, the followina 
equation is obtained. ~ a 

B(k) = -ZMPrec*Fz(k)/AMr Equation 24 
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Accordingly, p(k) obtained by Equation 24 is as shown by a solid line in Fig. 27, Note that a dotted line in Fig. 27 shows 
the body posture angular acceleration from time Ts to time Tm (shown by a solid line in Fig. 25). 
[0253] Incidentally, it is preferred that, in the normal gait, the body posture angular velocity at time Ts2 be equal to 
the body posture angular velocity at time Ts. If they are equal, fluctuation of the body posture angle becomes small. 

5 [0254] Thus, in order to cause the body postu re angular velocity at time Ts2 to be equal to the body posture angular 
velocity at time Ts, the body posture angular acceleration pattern is set so that an integral of the body posture angular 
acceleration p from time Ts to Lime Ts2 becomes zero. In other words, the body position angular acceleration pattern 
is set so that an integral of p(k) from time Tm to time Ts2 (integral of a portion shown by the solid line in Fig. 27) becomes 
a value obtained by multiplying an integral of the body posture angular acceleration from time Ts to time Tm (obtained 

10 in S504 to S51 6 in Fig. 22 as described earlier) by -1 . (An integral of. the body posture angular acceleration from time 
Ts to time Tm is an integral of the portion shown by the dotted line in Fig. 27, in other words, a difference between 
body posture angular accelerations at time Tm and time Ts.) 

[0255] More specifically, in this embodiment, in the trapezoid pattern of ZMPrec in Fig. 26, times of break points 
(determined based on the desired ZMP trajectory of the normal gait as described earlier) of the trapezoid are set to 
15 be known, and the height of the trapezoid is set as an unknown. Thus, the height of the trapezoid of ZMPrec (parameters 
defining the ZMPrec pattern) that satisfies the aforementioned relation is obtained. 

[0256] The height of the trapezoid of the ZMPrec in the first turning gait is called a first turning gait's body posture 
restoring moment's ZMP-converted value's trapezoid height acyd . The height of the trapezoid of the ZMPrec in the 
second turning gait is called a second turning gait's body posture restoring moment's ZMP-converted value's trapezoid 
20 height acye2. The ZMPrec in the second turning gait has a trapezoid pattern set during a period from timeTm2 to time Te. 
[0257] Supplementary, unless the gait parameters are changed while generating one step of current time gait, the 
ZMPrec pattern determined in S518 does not change (the same parameter values are calculated) during a period 
between time Tm and time Ts2 or between time Tm2 and time Te. Therefore, the processing of S518 may only be 

executed at time Tm and time Tm2. 
25 [0258] Next processing proceeds to S520, where an instantaneous value (present value) of the body posture re- 
storing moment ZMP-converted value ZM Prec at time k is calculated based on the parameters (height of the trapezoid) 

determined as above. * i 

[0259] Next, Processing proceeds to 522, where an instantaneous value (present value) of the aforementioned body 
posture angular acceleration pattern p at time k is calculated by the use of Equation 24 stated earlier. 
30 [0260] Next, processing proceeds to S524, where body horizontal acceleration atmp is obtained by the use of the 
dynamic model of the robot 1 . This body horizontal acceleration atmp is required to satisfy the desired ZMP at present 
time (time k) if the robot is caused to perform a movement not in the body rotation mode but in the body translation 
mode only from a state of last instantaneous desired gait of the robot (state of the desired gait at time k-1). This atmp 

is calculated in a manner similar to S504. 
35 [0261] Next, processing proceeds to S526, where the body horizontal acceleration a of the body translation mode 

is calculated by the use of the following equation. 

a = atmp - (AMr/AMp)*p Equation 25 

40 

[0262] Further, processing proceeds to S528, where the floor reaction force's horizontal component Fx at time k, in 
the case where the body horizontal acceleration is a obtained as above, is obtained by the following equation 26 similar 
to aforementioned Equation 17. 

Fx = mb* a + msup*d2Xsup/dt2 

+ mswg*d2Xswg/dt2 Equation 26 

so [0263] Supplementary, in order to improve accuracy of dynamic calculation, it is favorable that the body horizontal 
acceleration a of the body translation mode be determined in a similar manner to that explained in the supplement 
description of S51 6, instead of executing calculation of the body horizontal acceleration a using Equation 25 in S526. 
Specifically it is favorable that, after the body angular acceleration p is obtained in the foregoing manner, the body 
horizontal acceleration a of the body translation mode be analytically or searchingly determined by the use of a more 
55 rigorous dynamic model so that a movement, obtained by combining the body translation mode and body rotation mode 
producing the body angular acceleration p obtained above, satisfies the desired ZMP. 

[0264] The description provided above was about the processing when time k is neither between times Ts and Tm 
nor between times Ts2 and Tm2. 
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[0265] Fig. 28 shows the floor reaction force's horizontal component Fx when the processing described so far has 
completed to time Ts2. Further, Figs. 29 and 30 show the floor reaction force's horizontal component Fx and the body 
posture angular acceleration p, respectively, when the processing described so far has completed to time Te Note that 
the processing of S41 2 (subroutine for determining body h orizontal acceleration and body posture angular acceleration) 
described so far determines the instantaneous values of the body horizontal acceleration and body posture anqular 
acceleration al time k, but does not generate the lime series of them to time Te at once. 

[0266] Note thai, in this embodiment, the reference body posture is the vertical posture and the body poslure anqular 
acceleration by the reference body posture is thus zero. Therefore, the angular acceleration 0 of the body rotation 
mode obtained as described earlier is set as the body posture angular acceleration determined by the processing of 
S412. However, when the reference body posture trajectory parameter are set to change the reference body posture 
the sum of the angular acceleration p of the body rotation mode obtained as described earlier and the reference body 
posture angular acceleration should be set as the body posture angular acceleration determined by tho processing of 
S412. a 

[0267] The reason why times Ts, Tm and Ts2 are set as stated earlier is to prevent the floor reaction force's horizontal 
component Fx from exceeding the allowable range [Fxmin, Fxmax], even if the body posture angular acceleration B is 
generated to return the body posture angular velocity to the initial angular velocity of the reference body posture tra- 
jectory, during a period from time Tm to time Ts2 and a period from time Tm2 to time Te. In other words the floor 
reaction force's horizontal component allowable limit is sufficiently large during a period from time Tm to time Ts2 and 
a period from time Tm2 to time Te. Therefore, the floor reaction force's horizontal component Fx does not exceed the 
allowable range even if the body posture angular acceleration p is generated to return the body posture anqular velocity 
to the initial angular velocity while satisfying the desired ZMP. 

[0268] Moreover, in stead of causing the body posture angular velocity at time Ts to coincide with the body posture 
angular velocity at time Ts, the values of acyd and acyc2 may be set at equal values (acyd = acyc2) which permit 
the body posture angular velocity at time Te to coincide with the body posture angular velocity at time Ts 
[0269] Next, processing proceeds to S414 in Fig. 21 . In S414, the body horizontal acceleration obtained in S412 is 
sequentially integrated (cumulatively added from time Ts to current time k), thus obtaining a body horizontal velocity 
Further, the body horizontal velocity is sequentially integrated (cumulatively added from time Ts to current time k), thus 

position. In addition, the body posture angular acceleration obtained 
in S41 2 is sequentially integrated (cumulatively added from time Ts to current time k), thus obtaining a body posture 
angular velocity. Further, the body posture angular velocity is sequentially integrated (cumulatively added from time Ts 
to current time k), thus obtaining (the present value of) a body posture angle. 

[0270] After execution of the normal gait instantaneous value decision subroutine in S306 in Fig 20 processinq 
proceed to S308, where the value of time for gait generation k is increased by the gait generation interval Ak Next 
processing returns to S304, and processing of S306 and S308 is repeated as long as the conditions shown in S304 
hold. Once the conditions shown in S304 are not applicable, that is, upon completion of the provisional normal gait 
generation to the end (time Te = Ts + Tcyc), processing proceeds to S31 0. In S31 0, based on the final body posture 
angle (at time Te) of the provisional gait and the like obtained in the foregoing, an initial body posture angle (at time 
Ts) and an initial body posture angular velocity (at time Ts) are corrected according to the following equations These 
corrections are made to satisfy the boundary requirement of the normal gait related to the body posture angle and its 
angular velocity (the condition causing the body posture angles and angular velocities to coincide with each other at 
the beginning and end of the normal gait). Note that, in this description, the gait of the robot 1 is a gait for causing the 
robot 1 to move straight. 

[0271] In this case, new values in the following equations represent the corrected values. 



New initial body posture angular velocity 
- initial body posture angular velocity of provisional gait 
50 - (final body posture angle of provisional gait 

'- initial body posture angle of provisional gait)/Tcyc Equation 30 

55 New initial body posture angle 

- initial reference body posture angle (at time Ts) Equation 31 
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[02721 Hereinbelow, description is given regarding a reason why the initial body posture angular velocity is corrected 
by Equation 30 above. In the normal gait, it is required to determine the initial body posture angle and its angular 
velocity to prevent a state of movement of the robot 1 from being discontinuous (to satisfy the foregoing boundary 
requirement) at the boundary of the normal gait when the normal gait is repeated. In this case, by setting the body 
posture angular acceleration pattern corresponding to the foregoing body posture restoring moment ZMP-converted 
value ZMPrec, the final body posture angular velocity of the provisional normal gait obtained as above is generated to 
coincide with the initial value of the initial body posture angular velocity (initial value of reference body posture angular 
velocity). Thus, as long as the following equation, a remaining condition, is satisfied, the above-mentioned condition 
related to the body posture angle and its angular velocity is satisfied. 

Final body posture angle - initial body posture angle Equation 32 

and, 

second-order differential of body posture angle 

= body posture angular acceleration Equation 33 

Thus, by second-order integration of both sides of Equation 33 from the beginning to the end of the normal gait, a 
relation of the following equation is obtained. 

Final body posture angle = initial body posture angle 

■ 

+ initial body posture angular velocity * Tcyc 
+- second-order integral of body posture angular acceleration Equation 34 

[0273] Meanwhile, in generating the normal gait, the horizontal acceleration (adjustable horizontal velocity) of the 
body 24 is adjusted basically by the use of the body translation mode in order to satisfy the desired ZMP as described 
earlier However, in a situation where horizontal acceleration of the body 24 for satisfying the desired ZMP cannot be 
generated sufficiently (a situation where a sufficient friction force cannot be generated), the angular acceleration of the 
body posture angle is adjusted by the use of the body rotation movement mode while preventing the total gravity 
acceleration from changing. Thus, insufficient body horizontal acceleration duetothe body translation movementmode 
is compensated. 

[02741 The adjustment operation of the body posture angular acceleration by using the above-mentioned body ro- 
tation movement mode is approximately equivalent to adjustment of an angular acceleration of the flywheel FH in the 
model of the robot 1 with the flywheel FH shown in Fig. 10. if the rotation velocity of the flywheel FH is close to zero, 
gyroscopic precession does not occur, and a force generated by the flywheel FH is determined only by the angular 
acceleration of the flywheel FH. Therefore, in the robot 1 with the flywheel FH in the body 24, even if the initial angle 
and angular velocity of the flywheel FH are somewhat changed, the force generated does not change very much as 
long as the flywheel FH is moved by angular accelerations in equal pattern. Accordingly, gyroscopic precession is 
ignored in the dynamic equations of the robot, Equations 01 , 02 and 03. Therefore, when Equations 01 , 02 and 03 are 
used or even when a more general and rigorous dynamic model is used in the robot 1 of this embodiment, even if the 
initial body posture angle and its angular velocity are somewhat changed, a resultant force of inertial force and gravity, 
thus generated, is almost invariant as long as the body posture angle is moved by angular accelerations in the same 
pattern while preventing the total center-of-gravity acceleration from changing (that is, as long as the body posture 
angle is moved by angular accelerations in the same pattern by the use of the body rotation movement mode). In other 
words, even if the initial body posture angle and its angular velocity are somewhat changed, the body posture angular 
acceleration of the gait generated in accordance with the aforementioned flowchart is invariant. 
[02751 In short the second-order integral of the body posture angular acceleration in Equation 34 no longer depends 
on the initial body posture angle and its angular velocity. In other words, the second-order integral of the body posture 
acceleration can be treated as a constant value regardless of the values of the initial body posture angle and its angular 

[02767 When the value of the initial body posture angle is the initial body posture angle of the provisional gait and 
the value of the initial body angular velocity is the initial body angular velocity of the provisional gait, the final body 
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posture angle becomes the final body posture angle of the provisional gait. Therefore, this relation is substituted into 
Equation 34, obtaining the following equation. 

Final body posture angle of provisional gait 
= initial body posture angle of provisional gait 
+■ second-order integral of body posture angular acceleration 
+ initial body posture angular velocity of provisional gait * Tcyc Equation 35 

Thus, 

15 

Second-order integral of body posture angular acceleration 
= (final body posture angle of provisional gait - initial body 
20 posture angle of provisional gait) 

- initial body posture angular velocity of provisional gait * Tcyc Equation 36 

Based on the above argument, the second-order integral of the body posture angular acceleration can be treated as 
25 a constant. (The second-order integral of the body posture angular acceleration does not depend on the initial body 
posture angle and its angular velocity). Thus, above Equation is substituted into Equation 34, thus obtaining the fol- 
lowing equation. 

30 Final body posture angle = initial body posture angle 

+ (final body posture angle of provisional gait 
- initial body posture angle of provisional gait) 

35 

- initial body posture angular velocity of provisional gait * Tcyc 

+ initial body posture angular velocity* Tcyc Equation 37 

40 From Equations 37 and 32, foregoing Equation 30 is obtained. 

[0277] The initial body posture angle is caused to coincide with the initial value of the reference body posture angle 
: shown as in Equation 31 . However, the initial body posture angle may also be set such that an average value of the 

body posture angles of the normal gait coincides with the initial value of the reference body posture angle. Alternatively, 

the initial body posture angle may be set such that an average value of maximum and minimum values of the body 
45 posture angle of the normal gait coincides with the initial value of the reference body posture angle, 

[0278] I n the foregoing, description was provided regarding an example in wh ich a movement of the robot 1 is limited 

to a linear movement. In the case of determining a normal gait which includes a turning movement, the robot 1 has 
• different traveling directions at the beginning and end of the gait. Therefore, the initial body posture angular velocity 

depends on the initial body posture angle. Therefore, the initial body posture angle and its angular velocity need to be 
so determined under consideration of the above dependence. In this case, for example, it is sufficient that the initial body 

posture angle and initial body posture angular velocity are renewed to satisfy the following Equations 37a and 37b. 



55 



Final body posture angle - initial body posture angle 
= second-order integral of body posture angular acceleration 
determined to satisfy floor reaction force's horizontal component 
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allowable limit 

+- second-order integral of body posture angular acceleration 

generated by ZMPrec 
+ initial body posture angular velocity * period of the normal 

gait Equation 37a 

Final body posture angular velocity - initial body posture angular 

velocity 

= first-order integral of body posture angular acceleration 
determined to satisfy floor reaction force's horizontal component 

allowable limit 

+ first-order integral of body posture angular acceleration 

generated by ZMPrec Equation 37n 



[0279] The integral period of the first term on the right side of each of Equations 37a and 37b is a period obtained 
by combining a period from time Ts to time Tm, and a period from time Ts2 to time Tm2. The integral period of the 
second term on the right side of the same is a period obtained by combining a period from the time Tm to timeTs2 and 
30 a period from time Tm2 to time Te. 

[0280] * More specific description is provided. In the normal gait, initial body position angle and its angular velocity 
viewed from the first turning gait supporting leg coordinate system (next time gait's supporting leg coordinate system) 
should coincide with final body posture angle and its angular velocity viewed from the following first turning gait sup- 
porting leg coordinate system (next but two time gait's supporting leg coordinate system). Therefore, in this embodi- 
es ment, the new initial body posture angle is determined by foregoing Equation 31 . Thereafter, the new initial body posture 
angle is substituted for the initial body posture angle on the left side of Equation 37a. The coordinate of the new initial 
body posture angle is transformed into a value viewed from the next time gait's supporting leg coordinate system, by 
matrix (matrix of transformation of a rotating coordinate) corresponding to a total turning angle (turning angle about 
• the vertical axis) of the robot 1 in the normal gait. The resulting value is substituted for final body posture angle on the 
40 left side of Equation 37a. Further, the body posture angular acceleration sequentially obtained in S516 in Fig 22 de- 
scribed earlier is used for the body posture angular acceleration related to integration in the first term on the right side 
of each of Equations 37a and 37b. 

[0281] Thereafter, the initial body posture angular velocities in Equations 37a and 37b and the heights of the trape- 
zoids of the ZMPrec (trapezoid-shape pattern in Fig. 26) related to integration in the second term on the right side of 

45 Equations 37a and 37b are set as unknowns. (The times of break points of the trapezoid pattern of the ZMPrec are 
determined in advance, and the trapezoid height acyd of the ZMPrec in the first turning gait and the trapezoid height 
acyc2 of the ZMPrec in the second turning gait are equal values.) An initial body posture angular velocity, obtained by 
solving simultaneous equations 37a and 37b including the above unknowns, is determined as the new initial body 
posture angular velocity. In this case, the final body posture angular velocity in Equation 37b is a value obtained as 

so follows. The coordinate of the unknown initial body posture angular velocity is transformed into a value viewed from 
the next supporting leg coordinate system, by the matrix which corresponds to the foregoing total turning angle of the 
normal gait. 

[0282] When the movement of the robot 1 includes turning, the new initial body posture angle and its angular velocity 
may be- determined in the above-described manner. 
55 [0283] Note that, it is also possible to searchingly obtain an initial body posture angular velocity which satisfies the 
boundary requirement of the normal gait 

[0284] After the processing of S310 in Fig. 20 is completed, processing proceeds to S210 in Fig. 19. In S210, the 
final body horizontal position/velocity of the generated gait (provisional normal gait) are converted into values viewed 
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IvsTeminRa^ Th^Sf T™ ^ C ° rresponds t0 the sup P° rtin 9 le 9 at such moment <X'"-V"-Z"' coordinate 

es are s as (Xe ' Vxe) (Xe: final body horizontal position ' Vxe: final bod y hori2onta ' 

E? Jlc^ 6 ?;,^?^ !?"? Pr ° CeedS t0 S212 ' Wh6re differences between the initial body horizontal position/velocity 
Xs, Vxs) and final body horizontal position /velocity (Xe, Vxe) are calculated as shown in L drawing ZmeTnoes 
(Xs-Xe, Vxs-Vxe) are referred to as body horizontal position/velocity boundary requirement errors tenx envx> T the 
normal gait, the foregoing boundary requirement needs to be satisfied Thus fXs Vxs^Tnri «o w 1 1 T 5 
with each other. Hence, the body horizontal position/veiocity boundary' r^ment ^s^' e^lZTo 
or nearly zero. In th,s embodiment, (Xs, Vxs), with which the body horizontal poBWon^SS^^,,^ 
errors (errx, errvx) are almost zero, are searchingly obtained ooundary requirement 

hofnl NeXt '. proces t sin 9 P^ceeds to S214, where it is determined whether or not the calculated body position/velocity 
boundary requirement errors (orrx, errvx) are within their allowable ranges that are appropriately setb ^Sance IniS 
of sethng the allowable ranges of the body horizontal position/velocity boundary requfremen teno Z ~^£L TZ 
be determined whether or not a difference between an initial divergence component <* T Vxslo) and an Ta. diTeT 
gence component (Xe n- Vxe/coO), and a difference between an initial convergence components VM ^l 
end convergence component (Xe - VxeMO) are within corresponding allowable ranges respectSv Notelt n ic 
a predetermined certain value as mentioned earlier. respectively. Note that «0 is 

[02871 When the determination result in S214 is NO, processing proceeds to S216. In S216 a plurality of fin this 
embodiment, two) candidate initial values (Xs + AXs, Vxs) and (Xs, Vxs + AVxs) are determined neaS Vxs) Here 
£ndul 7T Predetermined amounts of Minute changes relative to Xs and Vxs, 

npnpraf h * " ^ 6mP '° yed 83 initia ' StateS ° f tne bod * hori2ontal Position/velocity, and L nor^XaUs 
generated using the gait parameters by processing similar to that of S208 described earl J Further the final bodv 
position/yelocity of the generated normal gait is converted into va.ues viewed from a supporting le ^oVdinat slstem 
which corresponds to the supporting leg at such moment (X"-Y»-Z" coordinate system in Fig 31 ) The vlZtus 

final body position/velocity corresponding to (Xs + AXs, Vxs), and (Xe + AXe2 Vxe + AVxe^mea i the fln^odv 
Z1T n V CO r POnClin9 10 (XS ' VXS + AVXS >' Note that < in thi * ProMMlni for generating the nom^a, gat £? 

mav be 5L" ^ ^ ^ * ^ Ts) ° f VanableS ° ther than the bod V horizontal po^l/velS 
may be set m a same manner as that in the case where the candidate initial values of the body horteon tel msS 

velocity are set as (Xs, Vxs). Further, in S216, differences between the respective candidate , ^ SS^dSST 

spending final body position/velocity, that is, the body horizontal position/velocity bouhda^t^S"^ ooZ 

^s^^T^^r (Xs + AXs < vxs) and (xs ' vxs 1 ^ « 

Vxs) respectively, the next candidate initial values of (Xs, Vxs) are determined by a searching memoc U mThod fn 
wh,ch affme-Jacobian (sensitivity matrix) is obtained and the next candidate is determined by a steepest desc* n meth- 
od, or a simplex method), Specifically, based on the body horizontal position/velocity bound™ ^uiremTnt erTrs 
correspond^ to (Xs, Vxs) and the candidate initial values (Xs + AXs, Vxs) and (Xs Vxs + AVxs ™ f Xs VxsT 
respectively, a sensitivity matrix is obtained which shows degrees of changes of the body horizom ^ posln/vobc'tv 

r err ° rS When minUte ° han9eS are made in the bod V horizontal position a^aKSSE^ 

ocity from ». .candidate initia, values (Xs, Vxs), respectively. Based on this matrix, candidate S^iTS^ 

rLTZ 9 - ? h ,v' ZOntal position/velocit V b °^ary requirement errors are newly determined Afte the new 
candidate init.a, values (Xs, Vxs) of the body horizontal position/velocity are determined as above, processing re^ Js 

L° 2 S2 9 1 ] 4 i J h No a ^^- deSCnbed processin 9 (Processing of S206-S21 8) is repeated as long as the determination result 
in S214 is NO. In this case, in S300 (see Fig. 20) of the processing for generating the normal aait fS20m which ^ 

ZTvtu T Can , didate initia ' Va ' UeS (XS ' VXS) ° f th£ b °^ horizontal pi nS h n ai iaTufof the 
body posture angular velocty is not set as the initial value of the reference body posture angular ve S bu as a 
value which was determined in S310 (see Fig. 20) in the processing of S208, anc Lc ^corresponds 2 las can 
d.date initial values (Xs, Vxs) of the body horizontal position/velocity. When the determination result ir S214 k YES 

meHS^rrf 115 S rePeatln9 l0 ° P (S204) and Pr ° ceeds t0 S220 ' No " s that, the piJS^SZZ^^i^. 
requirement £ Pr ° CeSS ' n 9 SXitS the rep6atin 9 '~P « ^ » obtained as the norma, gait satisf^ng'he boundary 

thfcurrert Sa^ ini£, boUT ^T', ( X0 - v °> * the originai initial time 0 (end time of 

^^X^T^^r^"^ (Z0, Vz0) at the initial time °' and initial body posture an ^ le 

[0291] Specifically, in S408 and S414 of the normal gait instantaneous value decision subroutine shown in Fig. 21 
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described earlier, (XO, VO) and (ZO, VzO) are determined as values obtained as follows. The body horizontal position/ 
velocity and body vertical position/velocity, determined at time of a switching moment from the second turning gait to 
the second turning gait, that is, determined when time k = Tcyc (time Te-Ts), are converted into values viewed from a 
supporting leg coordinate system (X"'-Y"'-Z'" coordinate system in Fig. 31) which corresponds to the supporting leg o 
a step starting from time Tcyc (that is, the supporting leg of the first turning gait in the second time), Similarly, the initial 
body posture angle and angular velocity are determined as values obtained as follows. The body posture angle and 
angular velocity determined when time k = Tcyc (lime Te-Ts) are converted into values viewed from a supporting leg 
coordinate system (X"'-Y" , -Z" 1 coordinate system in Fig. 31) which corresponds to the supporting leg of a step starting 
from the time Tcyc (that is, the supporting leg of the first turning gait in the second time). 

[0292] Next, processing proceeds to S222, where a normal gait's initial divergence component q[0] is obtained by 
the following equation. 

q[0] = XO + V0/o0 ' Equation 40 

where «>0 is a predetermined certain value, as stated earlier in the explanation regarding divergence. 

r02931 Processing proceeds to S224, where the normal gait initial divergence component q[0] is converted into a 

value viewed from the current time gait's supporting leg coordinate system, and the resulting value is obtained as q 

[0] In addition, the initial body vertical position/velocity (ZO, VzO) are converted into values viewed from the current 

time qait's supporting leg coordinate system, and the resulting values are obtained as (ZO", VzO' ). 

r02941 Supplementary, (ZO", VzO") coincide with body vertical position/velocity at the second turning gait s end, 

viewed from the supporting leg coordinate system of the second turning gait (X"-Y"-Z" coordinate system ,n Fig. 15). 

Further, q"[0] coincides with a divergence component at the second turning gait's end, viewed from the supporting eg 

coordinate system of the second turning gait ( X"-Y"-Z" coordinate system in Fig. 1 5). Therefore, (ZO", VzO") and q [0] 

mav be calculated by using such properties. . . . . . 

[0295] This is the end of the processing of S024 in Fig. 12, that is, subroutine processing for obtaining initial state 

rO^ei^rTe^processing proceeds to S026 in Fig. 12, where gait parameters of the current time gait is determined 
• (a part of the parameters are provisionally determined). To be more specific, in S026, the following processing is per- 
formed, following the flowchart shown in Fig. 32. 

[0297] First of all in S600, foot trajectory parameters of the current time gait are set so that the foot position/posture 
traiectories of the current time gait continue to the foot position/posture trajectories of the normal gait. 
T02981 Specifically, free leg foot position/posture at the current time gait's beginning (Initial values of current time gait 
free lea foot position/posture) are set as current free leg position/posture (free leg position/posture atthe last time gaits 
end) viewed from the current time gait's supporting leg coordinate system. Supporting leg foot position/posture at the 
current time gait's beginning (initial values of current time gait supporting leg foot position/posture) are set as current 
supporting leg foot position/posture (supporting leg foot position/posture at the last time gait's end) viewed from the 
current time gait's supporting leg coordinate system. Further, free leg foot position/posture at the current time gaits 
end is determined in accordance with the next time gait's supporting leg coordinate system (required values of free 
leq landinq position/posture of the first step related to the current time gait) viewed from current time gait s supporting 
leg coordinate system. In other words, the free leg foot position/posture at the current time gait's end is determined as 
follows When the free leg foot 22 is rotated while contacting a floor, from the free leg foot position/posture at the current 
time gait's end until almost entire bottom surface of the foot 22 contacts a floor so as not to slip, the representative 
point of the foot 22 coincides with the origin of the next time gait's supporting leg coordinate system viewed from the 
current time qait's supporting leg coordinate system. 

[0299] At the end of the current time gait, the supporting leg foot 22 Is lifted in the air. Supporting leg foot expected 
landinq position/posture are set in orderto determinetrajectories afterthe supporting legfoot 22 is lifted. The supporting 
leq foot expected landing position/posture are set, corresponding to the next but one time gaifs supporting leg coor- 
dinate system (required values of the free leg foot position/posture of the second step related to the current time gait) 
viewed from the current time gait's supporting leg coordinate system. More specifically, the supporting leg foot expected 
landing position/posture are set as follows. When the foot 22 is rotated, while contacting the floor, from the planned 
position/posture until almost entire bottom surface of the foot 22 contacts the floor so as not to slip, the representative 
point of the foot 22 coincides with the origin of the next but one time gait's supporting leg coordinate system, viewed 
from the current time gait's supporting leg coordinate system. 

r03001 Supporting leg foot position/posture at the current gait's end is obtained by generating foot position/posture 
traiectories from the current supporting leg position/posture (supporting leg foot position/posture at the current time 
qait's beginning) to the planned foot landing position/posture corresponding to the next time gaifs supporting leg co- 
ordinate system (required values of free leg foot expected landing position/posture of the second step in the foregoing 



42 



-i no AH I 



10 



15 



20 



25 



30 



35 



40 



45 



50 



EP 1 475 198 A1 

required parameters). The foot position/posture trajectories are obtained using the foregoing finite duration settling 
filter until the end of the current time gait. 

[0301] Next, processing proceeds to S602, where reference body posture trajectory parameters of the current time 
gait are determined as in the case of those for the first and second turning gaits of the normal gait. The parameters 
are set so that the reference body posture trajectory of the current time gait sequentially continues to the reference 
body posture trajectory of the foregoing normal gait (the reference body posture angle and its angular velocity at the 
end of the current time gail coincide with the reference body posture angle and its angular velocity at the beginning of 
the normal gait). Note that, in this embodiment, the reference body posture is the constantly vertical posture in anv of 
the current time gait and normal gait. 

[0302] Next, processing proceeds to S604, where arm posture trajectory parameters of the current time gait are 
determined as in the case of those forthe first and second turning gaits of the normal gait. The parameters are set so 
that the arm posture trajectories of the current time gait sequentially continue to the arm posture trajectories of the 
foregoing normal gait. Note that, as in the case where the normal gait parameters are determined (S104 in Fig 14) 
the arm posture trajectory parameters herein determined are movement parameters apart from those related to chang- 
es of angular momentum of both arms about the vertical axis (or body trunk axis), and are parameters defining trajec- 
tories of the center of gravity of both arms. ' 

[0303] Next, processing proceeds to S606, where floor reaction force's vertical component trajectory parameters of 
the current time gait are set, as in the case of those for the first and second turning gaits of the noimal gait so that a 
floor reaction force's vertical component trajectory defined by these parameters becomes substantially continuous 
(value does not become discontinuous in a stepwise manner) as shown in Fig. 6. 

[0304] The floor reaction force's vertical component trajectory parameters are determined so that both total center- 
of-gravity vertical position/velocity and floor reaction force's vertical component trajectory of the current time aait se- 
quentially continue to those of the normal gait. 

[0305] ■ Specifically, first of all, initial total center-of-gravity vertical position/velocity of the normal gait viewed from 
the current time gait's supporting leg coordinate system , are obtained by the use of, for example, Equation' 04 described 
earlier (or a kinematics model of the robot 1), based on the values (20", VzO") and the like. The values (20" VzO") 
To!,o^ ned by convertin 9 the initial body vertical position/velocity of the normal gait, finally obtained in the processing 
of S024 (decision processing of the normal gait initial state) of Fig. 12 described earlier, into values viewed from the 
current time gait's supporting leg coordinate system, that is, (20", VzO") obtained in S224 in Fig. 19, or the like Spe- 
cifically, the initialtotal center-of-gravity vertical position of the normal gait, viewed from the currenttime gait's supporting 
leg coordinate system, is obtained by substituting the following into Equation 04. Substituted are: the body material 
particle's vertical position of the model in Fig. 10, corresponding to the body vertical position Z0" of the normal gait 
obtained in S224; and leg material particle vertical positions on the supporting leg side and free leg side, corresponding 
to positions obtained by converting the positions of the respective legs at the beginning of the normal gait into values 
viewed from the current time gait's supporting leg coordinate system. Moreover, the initial total center of gravity's vertical 
velocity of the normal gait, viewed from the current time gait's supporting leg coordinate system, is obtained by sub- 
stituting the following for an equation obtained by differentiating both sides of Equation 04. Substituted are- the body 
material particle vertical velocity of the model in Fig. 10, corresponding to the body vertical velocity VzO" of the normal 
gait obtained in S224; and leg material particle vertical velocities on the supporting leg side and free leg side corre- 
sponding to velocities obtained by converting the respective foot vertical velocities in the normal gait into values viewed 
from the currenttime gait's supporting leg coordinate system. Note that, the initial total center-of-gravity vertical position/ 
velocity may be calculated by the use of a more precise model. 

[0306] Thereafter, the initial total center-of-gravity vertical position/velocity of the normal gait obtained as above are 
substituted for the end total center of gravity's vertical position/velocity of forgoing Equations 13 and 41 At the same 
time,- the total center-of-gravity vertical position and velocity of the last desired gait instantaneous values (more pre- 
cisely, resulting values of conversion of the end state of the last desired gait into the present supporting leg coordinate 
system) are substituted for the initial total center-of-gravity vertical position and velocity in foregoing Equations 13 and 
41 . The floor reaction force's vertical component pattern (more specifically, parameter values) of the current time qait 
is thus determined to satisfy the relations in Equations 1 3 and 41 . Integrals in Equations 1 3 and 41 are integrals durinq 
a period from the beginning to the end of the current time gait. 



End total center of gravity's vertical velocity - initial total 
55 center of gravity's vertical velocity 

= first-order integral of (floor reaction force's vertical 
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+ 



component/mass of robot) 
first-order integral of gravity acceleration Equation 41 



[0307] The gravity acceleration is a negative value. 

[0308] More specifically, first of all, among floor reaction force's vertical component parameters (times of break points, 
and the like) for defining the floor reaction force's vertical component pattern shown in Fig. 6, at least two parameters 
are set as independent unknown variables and the values of the unknown variables are determined by solving simul- 

w taneous equations including Equations 13 and 41 . 

[0309] For example, the height (peak value of the floor reaction force's vertical component) and width (duration of 
the one-leg supporting period) of the trapezoid in Fig. 6 may be selected as the floor reaction force's vertical component 
parameters set as unknown variables. In this case, inclinations of both sides of the trapezoid in Fig. 6 are values 
determined in advance in accordance with the current time gait's period or the like. Alternatively, times of the break 

15 points of the floor reaction force's vertical component pattern , except for time of shift from the one-leg supporting period 
to the floating period, are values determined in advance in accordance with the current time gait's period or the like. 
Supplementary if the number of unknowns is one, there is generally no solution which satisfies the simultaneous 

equations of Equations 1 3 and 41 . . u . 

[0310] Next, processing proceed to S608, where floor reaction force's horizontal component allowable limit LFxmm, 

20 Fxmax] (to be more specific, parameters defining a pattern of the floor reaction force's horizontal component allowable 
limit) is set as in the case of the first and second turning gaits of the norma! gait. For example, the floor reaction force's 
horizontal component allowable limit is set to have the pattern shown in Fig. 33. In this embodiment, the floor reaction 
force's horizontal component allowable limit (to be more specific, a allowable range in each of the X-axis and Y-axis 
directions) is set based on foregoing Equation 12, in accordance with the floor reaction force's vertical component 

25 pattern determined earlier in S606. Note that, it is preferred that this floor reaction force's horizontal component allow- 
able limit herein set certainly remain within the friction limit. 

[0311] Next processing proceeds to S610, where a ZMP trajectory of the current time gait (to be more specific, 
parameters defining the ZMP trajectory; times and positions of break points of the trajectory) is set as shown in Fig. 7 
described earlier, so as to have high stability margin and not to change suddenly, as in the case of the first and second 

30 turning gaits of the normal gait. These parameters are set so that the ZMP trajectory of the current time gait sequentially 
continues to the ZMP trajectory of the foregoing norma! gait. In other words, the ZMP trajectory parameters are deter- 
mined so that the position of the ZMP at the end of the current time gait coincides with the position of the ZMP at the 
beginning of the normal gait, in this case, in the running gait, the way of setting times and positions of break points of 
the ZMP trajectory during the one-leg supporting period may be similar to the way of setting the ZMP trajectory pa- 

35 rameters of the foregoing normal gait. In addition, the ZMP trajectory parameters can be set so that the desired ZMP 
trajectory during the floating period linearly and continuously changes from the position of ZMP at initial time of the 
floating period to the position of ZMP at the beginning of the normal gait. 

[0312] Note that, the ZMP trajectory parameters of the current time gait determined in S610 are determined only 
provisionally and will be corrected as described later. Therefore, the ZMP trajectory of the cu rrent time gait set as above 

40 is hereinafter referred to as a provisional desired ZMP trajectory of the current time gait. 

[0313] Finally, processing proceeds to S612, where a body posture angle recovery period [Ta, Tb] is set. Body posture 
angle recovery initial time Ta is equivalent to Tm in the second turning gait of the normal gait, and body posture angle 
recovery end time Tb is equivalent to Ts2 in the second turning gait of the normal gait. The ways of setting times Ta 
and Tb are similar to the ways of setting Tm and Ts2, respectively. 

45 [0314] Returning to description of Fig. 12, after the processing shown in S026 (decision processing of the gait pa- 
rameters of the current time gait) is performed as above, processing proceeds to S028, where the gait parameters 
(ZMP trajectory parameters) of the current time gait are corrected. In this processing, the ZMP trajectory parameters 
are corrected to allow the body position/posture trajectories to continue to or to be close to those of the normal gait. 
[0315] Fig. 34 is a subroutine flowchart showing above processing. 

so [031 6] First of all, after S700, processing proceeds to S702, where a provisional current time gait to the end time of 
the current time gait is generated provisionally based on the provisional desired ZMP pattern and other current time 
gait parameters. 

[0317] In S702, the processing below is performed following the flowchart shown in Fig. 35. 
[0318] Description is given hereinbelow. Various initialization is performed in S800. To be specific, zero is substituted 
55 for time for provisional gait generation k. Further, the end state (to be more specific, end values of the gait state, such 
as the body horizontal position/Velocity, body vertical position/velocity, body posture angle and its angular velocity, 
desired foot position/posture, desired arm postures and the like) of the last desired gait is converted into the present 
supporting leg coordinate system, and the resultant state is set as the current time gait initial state. 
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[0319] Next, in S804 after S802, it is determined whether or not timefor provisional gait generation kis before current 
time gait end time Tcurr (whether or not k < Tcurr). If the determination result is YES, processing proceeds to current 
time gait instantaneous value decision subroutine of S806, and an instantaneous value of time k in the current time 
gait is determined. Next, processing proceeds to S808, where time for provisional gait generation k is increased bv 
Ak. Thereafter, processing returns to S804. 

[0320] If Lhe determination result of S804 is NO, the processing of the flowchart shown in Fig. 35 is completed 
[0321] By the above processing, the provisional current time gait is generated from the beginning to the end 
[0322] in the gait instantaneous value decision subroutine in S806, processing shown in Fig. 36 is performed De- 
scription of the processing is given hereinbelow. 

[0323] First of all, in S900, a value (present value) of the desired floor reaction force's vertical component shown in 
Fig. 6 at time k is obtained based on the floor reaction force's vertical component trajectory parameters of the current 
time gait parameters. Next, in S902, a value (present value) of the desired ZMP trajectory (provisional desired ZMP 
trajectory) shown in Fig. 7 at time k is obtained based on the ZMP trajectory parameters of the current time qait oa- 
rameters. a k 

[0324] Next, processing proceeds to S904, where values (present values) of the desired both foot positions/postures 
reference body posture and desired arm postures at time k are respectively obtained based on the current time gait 
parameters (foot trajectory parameters, reference body posture trajectory parameters and arm posture trajectory pa- 
rameters). As for the desired arm postures, total center of gravity of the arms is determined, but freedom of movement 
which changes angular momentum about the vertical axis (or body trunk axis) is not yet determined Note that as in 
the case of the normal gait, the desired foot position/posture trajectories and floor reaction force's vertical component 
trajectory of the current time gait are determined independently from each other, in accordance with the foot trajectory 
parameters and floor reaction .force's vertical component trajectory parameters determined in the flowchart in Fia 32 
respectively. a ' 

[0325] Next, processing proceeds to S906, where a total center-of-gravity vertical position at time k is calculated to 
satisfy the present value of the desired floor reaction force's vertical component obtained in S900 (to cause the sum 
of an inertial force and gravity in the vertical direction of the robot 1 to balance with the desired floor reaction force's 
vertical component). Specifically, this calculation is performed by processing similarto that of S406 in Fig. 21 described 

[0326] Next, processing proceeds to S908, where a present value of the body vertical position, which satisfies the 
total center-of-gravity vertical position obtained as above, is calculated. Specifically, this calculation is performed bv 
processing similar to that of S408 in Fig. 21. 

[0327] Next, processing proceeds to S910, where values (present values) of the floor reaction force's horizontal 
component allowable limit [Fxmin, Fxmax] shown in Fig. 33 are obtained based on the parameters of floor reaction 
force's horizontal component allowable limit determined in S608 in Fig. 32 described earlier. 

[0328] Next, processing proceeds to S912, where body horizontal acceleration and body posture angular accelera- 
tion of the provisional current time gait are determined to satisfy the desired ZMP (to cause the moment's horizontal 
component generated about the desired ZMP to be zero). Note that, these accelerations are determined so that the 
floor reaction force's horizontal component Fx does not exceed [Fxmin, Fxmax], This processing is slightly different 
from the processing of the flowchart in Fig. 22 showing the details of S412 in Fig. 21 . ~ 
[0329] To be specific, in S912, processing shown in the flowchart of Fig. 37 is performed. In the flowchart of Fig 37 
first of all, in S1 000, it is determined whether or not time k is in the body posture angle recovery period [Ta Tbl set in 
S612 in Fig. 32 described earlier. ' 
[0330] If the determination result is NO (if the floor reaction force's horizontal component allowable limit is zero or 
narrow), processing from S1 002 to S101 4 is executed. The processing from S1 002 to S1 01 4 is thesame as the process- 
ing from S504 to S516 in Fig. 22 described earlier. Thus, description thereof is omitted. 

[0331] When the determination result in S1000 is YES, processing proceeds to S101 6, where a pattern of body 
posture restoring moment ZMP-converted value ZMPrec is set. In this case, the ZMPrec is set to have a pattern with 
a constant value of zero (in other words, a pattern when the height of the trapezoid pattern shown in Fig 26 is zero) 
This is different from S518 in foregoing Fig. 22 related to generation of the normal gait. Next, processing from S1018 
to S1026 is performed. The processing from S1018 to S1026 is the same as the processing from S520 to S528 in 
foregoing Fig. 22. Thus, description thereof is omitted. Note that, in the processing from S1016 to S1026 the instan- 
taneous value of the body posture restoring moment ZMP-converted value ZMPrec is always zero. Thus body posture 
angular acceleration p of the body rotation mode obtained in S1020 is also zero. Therefore, only the processing of 

S1022, S1024andS1026 may be performed with|3 = 0. Ifthe determination result inS1000 is YES that is duringthe 
body posture angle recovery period [Ta, Tb], p = 0 as described above. Therefore, in the processing of S912 unlike 
the case of generating the normal gait, a movement trajectory of the body posture change in a recovery direction of 
the body posture angular velocity is not generated during the body posture angle recovery period [Ta Tbl (period with 
sufficiently large floor reaction force's horizontal component allowable limit). 
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[0332] Note that, in this embodiment, the reference body posture is the vertical posture and the body posture angular 
acceleration by the reference body posture is thus zero. Therefore, the angular acceleration (3 of the body rotation 
mode obtained as described earlier is set as the body posture angular acceleration determined in the processing S91 2. 
However, when the reference body posture trajectory parameters are set to change the reference body posture, the 

5 • body posture angular acceleration determined in the processing of S91 2 should be the sum of the angular acceleration 
P of the body rotation mode obtained as described earlier and the reference body posture angular acceleration. 
[0333] After the processing of S91 2 in Fig. 36 is completed as above, processing next proceeds to S91 4, where Ihe 
body horizontal acceleration obtained in S912 is sequentially integrated (cumulatively added from the current time 
gait's beginning (time k=0) to current time k), thus obtaining a body horizontal velocity. Further, the body horizontal 

10 velocity is sequentially integrated (cumulatively added from the current time gait's beginning (time k=0) to current time 
k), thus obtaining (the present value of) a body horizontal position. In addition, the body posture angular acceleration 
obtained in S912 is sequentially integrated (cumulatively added from the current time gait's beginning (time k=0) to 
currenttime k), thus obtaining a body posture angular velocity. Further, the body posture angular velocity is sequentially 
integrated (cumulatively added from the current time gait's beginning (time k-0) to current time k), thus obtaining the 

15 present value of a body posture angle. The processing of S914 is similar to the processing of S414 in Fig. 21. 

[0334] The current time gait instantaneous value decision subroutine in S806 in Fig. 35 is executed as above, and 
' processing next proceeds to S808, where the value of the gait generation time k is increased by a gait generation 
interval Ak. Next, processing returns to S804, and the processing of S806 and S808 is repeated as long as the conditions 
shown in S804 are applicable. Once the conditions shown in S804 are no longer applicable, that is, once generation 

20 of the provisional currenttime gait is completed to the end, processing proceeds to S704 in Fig. 34. 

[0335] In S704, an final divergence component qO[k](k=Tcurr) is obtained using the equation in the drawing (foregoing 
Equation 10), from the body horizontal position velocity (Xe, Vxe) at the end of the current time gait obtained in S702 
as above. 

[0336] Next, processing proceeds S706, where an final divergence component error errq is obtained using the equa- 
ls tion in the drawing. The final divergence component error errq is a difference between the current time gait final diver- 
gence component q0[k] and the normal gait initial divergence component q" (obtained in S224 in Fig. 19). Further, 
processing proceeds to S708, where it is determined whether or not the obtained final divergence component error 
errq is within the allowable range (a range near zero). 

[0337] When the determination result in S708 is NO, processing proceeds to S71 0, where a = Aa is set (Aa is a 
30 predetermined minute amount), and the provisional current time gait until the end is calculated as in the case of fore- 
going S702, based on the desired ZMP obtained by adding a trapezoid-shaped correction to the current provisional 
desired ZMP pattern in accordance with the relation shown in Fig. 38. Here, referring to Fig. 38, a is the height of 
trapezoid pattern for correcting the provisional desired ZMP in order to permit the current time gait final divergence 
component to coincide with the normal gait initial divergence component as much as . possible (to permit the body 

35 horizontal position/posture trajectories of the current time gait to be close to the body horizontal position/posture tra- 
jectories of the normal gait). In this case, in the present embodiment, the provisional desired ZMP is corrected during 
a period when almost entire bottom surface of the supporting leg foot 22 contacts the floor (entire foot bottom surface 
floor contacting period), that is, a period when the floor reaction force's horizontal component allowable limit is suffi- 
ciently large. Times of break points of the above-mentioned trapezoid pattern are set to coincide with the times of the 

40 break points of the provisional desired ZMP during the entire foot bottom surface floor contacting period. Note that, a 
= Aa is set in S71 0 in order to observe changes of the foregoing final divergence component error errg when the current 
provisional desired ZMP trajectory is corrected by the foregoing trapezoid pattern by a minute amount. 
[0338] I n S71 0, the provisional current time gait is generated to the end when a = Aa is set and the provisional desired 
ZMP trajectory is corrected. Thereafter, processing proceeds to S712. In S712, based on body horizontal position/ 

45 velocity (Xe1 , Vxe1) at the end of the provisional current time gait obtained in S71 0, an final divergence component 
q1[k] of the provisional currenttime gait is obtained using the equation in the drawing (foregoing Equation 10). 
[0339] In this embodiment, in S710, Aa is a constant of a minute amount set as appropriate. However, Aa may be 
set to be decreased by a repeat operation described below as the final divergence component error errq becomes 
small. Nevertheless, even when the Aa is a constant, the final divergence component error errq can remain within the 

so allowable range by several repeat operations. 

[0340] Next, processing proceeds to S714, where parameter sensitivity r (a rate of change of the final divergence 
component error relative to Aa) is obtained from the equation in the drawing. Further, processing proceeds to S71 6, 
where a - -errq/r is set, that is, the height a of the trapezoid pattern is set as a value obtained by dividing the final 
divergence component error errq obtained in S706 by the parameter sensitivity r obtained in S714. In addition, a cor- 

55 rection amount having the trapezoid pattern with the height a is added to the provisional desired ZMP pattern in ac- 
cordance with the relation shown in Fig. 38, thus correcting the provisional desired ZMP pattern (thus determining new 
provisional desired ZMP pattern). 

[0341] Next, processing returns to S702. Thereafter, the processing of S702 to S716 described above is repeated 
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as long as the determination result in S708 is NO. When the determination result is YES. processing exits the reoeatina 
loop (S700) and proceeds to S71 8. y 

[0342] In S71 8, based on a difference between the final body posture angle of the provisional current time qait and 
the initial body posture angle of the normal gait, a difference between the final body posture angular velocity of the 
provisional current time gait and the initial body posture angular velocity of the normal gait, and the like a pattern of 
a ZMP-converted value of the body poslure restoring moment (ZMPrec) of Ihe current time gait is determined so that 
the body posture angle or ihe current time gait becomes close to the body posture angle of the normal gait The ZMPrec 
determined here is for correcting the provisional desired ZMP so that the coincidence of the current time gait final 
divergence component with the normal gait initial divergence component is maintained (the condition in S708 is main- 
tained) even when the body posture angular acceleration is generated to allow the body posture angle trajectory of 
the current time gait to continue (to be close) to that of the normal gait during a period when the floor reaction force's 
horizontal component allowable limit is sufficiently large (period within the one-log supporting period) in later-described 
processing for generating current time gait instantaneous values. 

[0343] The ZMPrec has a trapezoid-shaped pattern, as in the case of the ZMPrec described in the foregoing normal 
gait generation processing. Specifically, the ZMPrec is determined as follows. In the trapezoid pattern of the ZMPrec 
shown in Fig. 26, the times of peaks (break points) of the trapezoid are set to be known (to be more specific the times 
of break points of the trapezoid are caused to meet the times of break points of the desired ZMP) and the height of 
the trapezoid is set to be unknown. Thereafter, the height of the trapezoid (parameter) of the ZMPrec is obtained as 
described below. In S71 8, Tm and Ts2 in Fig. 26 are substituted by Ta and Tb, respectively. 

[0344] When the number of the unknown parameter of the pattern of the body posture restoring moment ZMP- 
converted value is one as above, it is generally impossible that both body posture angle and body posture anqular 
velocity at the end of.the current time gait sequentially continue to those of the normal gait. Therefore in this embod- 
iment, the unknown parameter is detennined so that a state of a generated gait gets gradually closer to a state of the 
normal gait through a plurality of steps. 

[0345] Supplementarily, it may be possible to make the ZM Prec pattern in one gait complicated and to have two or 
more unknown parameters in order to cause both body posture angle and body posture angular velocity to sequentially 
continue to those of the normal gait. However, there is a possibility that the ZMPrec pattern excessively fluctuates in 
a zig-zag manner. 

[0346] • Hereinbelow, after description of a principle of calculation, a calculation procedure is described 
[0347] Obtained is a difference between the final body posture angle of the provisional current time gait and the initial 
body posture angle of the normal gait, and this difference is set as eerr. The provisional current time gait is obtained 
in S702 as described above with the height of the trapezoid of the ZMPrec pattern set as zero Further a difference 
between the final body posture angular velocity of the provisional current time gait and the initial body posture anaular 
velocity of the normal gait is obtained and set as veerr. 

[0348] Here, it is assumed that the current time gait is generated while letting the height of the trapezoid of the 
ZMPrec pattern be a given value bcurr, and the first turning gait is subsequently generated by algorithm similar to that 
of the current time gait. The pattern of body posture restoring moment ZMP-converted value ZMPrec of the first turninq 
gait is set as the sum of the ZMPrec pattern of the first turning gait obtained in S51 8 in Fig. 22 (trapezoid pattern in 
Fig. 26 whose height is acyd described earlier) and a given value b1 . 

[0349] A gait generated as above is referred to as a ZMPrec corrected gait, and body posture angle and its anqular 
velocity at the end of the gait (end of the first turning gait) are set as 61 and v01 , respectively. 

[0350] Body posture angle and its angular velocity at the first turning gait's end of the original normal gait are set as 
61 org and v81 org, respectively. The original normal gait (normal gait in a case where the body posture angle and its 
angular velocity at the normal gait's beginning, ultimately determined by Equations 30 and 31 of S310 are set as initial 
values, and the ZMPrec pattern is set as the pattern obtained in S518 (trapezoid pattern in Fig. 26 whose height is 
acyd)) is obtained upon completion of the processing of the subroutine in S024 for obtaining the initial state of the 
normal gait. 

[0351] Here, A61 and Av61 are defined as follows. 

A01 = 61-61 org Equation 50 

AV01 = v01 -vGlorg Equation 51 

[0352] A61 and Av61 mean a difference between the body posture angles and a difference between angular velocities 
of the ZMPrec corrected gait and the original normal gait, respectively, at the point where both gaits are generated to 
the end of the first gait. If A61 and Ave are zero, the second turning gait where the height of trapezoid of the ZMPrec 
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pattern is set as acyc2, is generated subsequently to the ZMPrec corrected gait by algorithm similar to that of the 
current time gait. Thus, the second turning gait coincides with the original normal gait. 

[0353] Therefore,thecurrenttimegaittrapezoidheightbcurr,andthefirsttuminggaittrapezoid height b1 are obtained 
so that Aet and Av61 become zero. The obtained bcurr can be finally determined as the trapezoid height of the current 
time gait. 

[0354] Incidentally, the dynamic model related to the body posture angle of the robot 1 has a linear characteristics 
like the flywheel FH shown in Fig. 10. Therefore, A61 and Ave have the following relations with the current time gait 
trapezoid height bcurr, the first turning gait trapezoid height b1 , the difference eerr between the final body posture angle 
of the provisional current time gait and the initial body posture angle of the normal gait, and the difference vGerr between 
the final body posture angle of the provisional current time' gait and the initial body posture angular velocity of the 
normal gait. 

A01 = c11*bcurr-KCl2*b1 + Berr + e1*vGerr Equation 52 

i 

Av01 - c21*bcurr+ c22*b1 + e2*vGerr Equation 53 

where c11, c12, c21 , c22, e1 and e2 are coefficients uniquely determined by parameters (particularly, parameters 
related to time) of the currenttime gait, a gait period of the first turning gait, and the pattern of the body posture restoring 
moment ZMP-con verted value ZMPrec, and the like. 

[0355] Based on the above principle, the difference Gerr between body posture angles and the difference vGerr be- 
tween angular velocities at the boundary of the provisional current time gait and the normal gait are first obtained as 

the calculation procedure. , . 

[0356] Next, c11 , c12, c21 , c22, e1 , and e2, the coefficients of Equations 52 and 53, are obtained based on the 
parameters (particularly, parameters related to time) of the current time gait, the gait period of the first turning gait and 
the pattern of the body posture restoring moment ZMP-converted value ZMPrec, and the like. 
[0357] Next, the current time gait trapezoid height bcurr and the first turning gait trapezoid height b1 are determined 
so that the right sides of Equations 52 and 53 become zero. In other words, bcurr and b1 are obtained by solving a 
simultaneous equation in which the right sides of Equations 52 and 53 are zero. 

[0358] Finally, the height of the trapezoid pattern of the body posture restoring moment ZMP-converted value (ZM- 
Prec) of the current time gait is set as bcurr, the currenttime gait trapezoid height obtained above. 
[0359] Next, processing proceeds to S720, where a desired ZMP pattern of the current time gait is determined. This 
desired ZMP pattern is a pattern obtained by adding the pattern of the body posture restoring moment ZMP-converted 
value obtained in S71 8 as above to the current provisional desired ZMP pattern (provisional desired ZMP pattern when 
processing exits the repeating loop in S700). Note that, this processing is similar to the processing in S710 to add the 
trapezoid pattern with the height Aa to the provisional desired ZMP pattern. 

[0360] Described below is the reason why the pattern of the body posture restoring moment ZMP-converted value 
is added to the provisional desired ZMP pattern. 

[0361] As described earlier, the provisional current time gait generated in the loop of S700 is generated where the 
body posture restoring moment ZMP-converted value ZMPrec is zero (the height parameter of the trapezoid pattern 
of the ZMPrec is zero). In the provisional current time gait finally generated in the loop of S700 as above, the body 
posture velocity continues to or becomes close to that of the normal gait. However, the body posture angle shifts from 
the body posture angle of the normal gait or diverges in some cases. 

[0362] The pattern of the body posture restoring moment ZMP-converted value obtained in S71 8 generates a body 
posture angular acceleration for reducing the shift of the body posture angle from that of the normal gait to zero. 
[0363] However, if the body posture angular acceleration in accordance with the pattern of the body posture restoring 
moment ZMP-converted value obtained in S718 is generated without correcting the provisional desired ZMP pattern 
finally obtained in the loop of S700, a body horizontal position trajectory has to be shifted from the body horizontal 
position trajectory of the foregoing provisional current time gait in order to satisfy the dynamic equilibrium conditions 
(where the moment, except for the vertical component, acted on the desired ZMP by the resultant force of the inertial 
force and gravity of the robot becomes zero). Therefore, in this embodiment, the provisional desired ZMP pattern is 
corrected by the ZMPrec so that the body horizontal position trajectory does not need to be shifted from the body 
horizontal position finally obtained in the loop of S700. 

[0364] If the body posture angular acceleration corresponding to the pattern of the body posture restoring moment 
ZMP-converted value obtained in S718 is generated on top of the movement of the aforementioned provisional current 
time gait, the ZMP (a point at which the moment, except for the vertical component, of the resultant force of the inertial 
force and gravity generated by movement becomes zero) shifts by the body posture restoring moment ZMP-converted 
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value. Therefore, on the other hand', a pattern obtained by adding the pattern on the body posture restoring moment 
ZMP-converted value to the provisional desired ZMP pattern is set as the desired ZMP pattern. Thereafter, the current 
time gait which satisfies the desired ZM P pattern is generated while generating the body posture angular acceleration 
in the body rotation mode corresponding to the pattern of the body posture restoring moment ZMP-converted value 
obtained in S7T8. Thus, the current time gait becomes the body translation movement, which is the same as the 
foregoing provisional current time gait. 

[0365] The foregoing is the reason why the desired ZMP pattern is set as the pattern obtained by adding the pattern 
of the body posture restoring moment ZMP-converted value to the provisional desired ZMP pattern. 
[0366] Returning to Fig. 12, after the current time gait parameters are corrected as above in S028, processing pro- 
ceeds to S029, where parameters are determined which define the allowable range of the floor reaction force's moment 
about the desired ZMP (to be more specific, a horizontal component of the floor reaction force's moment). Note that, 
the floor reaction force's moment is divided by the floor reaction force's vertical component, and the resulting value 
expresses a deviation of the ZMP (floor reaction force central point) from the desired ZMP. Hence, the parameters of 
the allowable range of ZMP which have been converted into the floor reaction force central point (floor reaction force 
central point allowable range) may be set by dividing the floor reaction force's moment allowable range by the floor 
reaction force's vertical component. 
[0367] The floor reaction force's moment allowable range determined in S029 is a allowable range of an actual floor 
reaction force's moment about the desired ZMP, controlled by control processing (compliance control) of the foregoing 
composite-compliance operation determinator 1 04. The allowable range of floor reaction force's moment is described 
20 hereinbefow. 

[0368] The compliance control by processing of the composite-compliance operation determinator 1 04 controls the 
position/posture of the foot 22 so that the floor reaction force's moment generated about the desired ZMP becomes 
the desired floor reaction force's moment for compliance control. When the compliance control is operated faithfully 
as desired, the actual floor reaction force central point shifts to a point where a value obtained by dividing the desired 
floor reaction force's moment by the vertical floor reaction force is added to or subtracted from the desired ZMP. The 
actual floor reaction force central point cannot exceed a range, expressed as a so-called support polygon, where the 
ZMP can exist (strictly speaking, a range where a point of action of the actual floor reaction force centra! point can 
exist). However, if the actual floor reaction force seems about to exceed the range (in other words, the actual floor 
reaction force central point is too close to the boundary of the range where the ZMP can exist), problems occur such 
as lowering foot 22's original sense of contact with the floor and raising foot 22's bottom surface. 
[0369] The floor reaction force's moment allowable range is for limiting the desired floor reaction force's moment of 
the compliance control, in order to prevent such problems. To be precise, the floor reaction force's moment allowable 
range is set for a recovery condition 1 described in the second embodiment described later. However, in the case of 
satisfying forgoing Equation d27 like this embodiment, setting the floor reaction force's moment allowable range for 
the recovery condition 1 is equivalent to limiting the desired floor reaction force's moment for compliance control not 
to exceed the floor reaction force's moment allowable range. 

[0370] Therefore, it is preferred that the floor reaction force's moment allowable range be set so that the floor reaction 
force central point allowable range obtained by dividing the floor reaction force's moment allowable range by the floor 
reaction force's vertical component, is included in the range where the ZMP can exist. 

[0371] To be more specific, the floor reaction force central point allowable range (ZMP allowable range) should be 
determined to correspond to the support polygon, and generally has a complicated shape. Here, however, the allowable 
range is basically set as a rectangle region on the floor surface in orderto simplify the calculation. In other words, the 
floor reaction force central point allowable ranges, thus, the floor reaction force's moment allowable ranges obtained 
by converting the floor reaction force central point into the floor reaction force's moment, are set independently for a 
component in the front- an d-back direction (X-axis direction) and a component in the right-and-left direction (Y-axis 
direction). 

[0372] For example, when the support polygon and the desired ZMP are in a situation shown in Fig. 39, the ZMP 
allowable range is set to be included in the support polygon as shown in the drawing. At the same time, the ZMP 
allowable range is set to include the desired ZMP. Note that the support polygon in the example in Fig. 39 is the one 
during the two-leg supporting period in the walking gait (supplementary description will be specifically provided later 
regarding gait generation related to the walking gait). Rectangular portions on both sides of the support polygon rep- 
resent positions of the feet 22 of the respective legs 2. The right foot 22 contacts a floor with its toe, and the left foot 
22 contacts the floor with its heel. 

[0373] During the one-leg supporting period in the walking gait or the running gait in foregoing Fig. 5, the support 
polygon is a contact surface (surface contacting the floor surface) of the supporting leg foot 22. In this case, the ZM P 
allowable range is set to include the desired ZMP and to be included in the support polygon or to almost coincide with 
the support polygon. During the floating period of the running gait in foregoing Fig. 5, the ZMP allowable range is set 
as, for example, a region with zero width in both X-axis and Y-axis directions about the desired ZMP set as the center, 
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that is, a point of the desired ZMP itself (which means a region with zero area). 

[0374] Returning back to Fig. 12, after the floor reaction force's moment allowable range is determined in S029 as t 
described above, or when the determination result in S016 is NO, processing proceeds to S030, where current time 
gait instantaneous values are determined. In S030, the gait instantaneous values are determined so that the model 
5 manipulation floor reaction force's moment determined in accordance with foregoing Equation d26 is generated about 
the desired ZMP. 

[0375] Specifically, the gail instantaneous values are determined in accordance with the flowcharts in Figs. 40 and 
41 . In other words, in S030, processing from S1000 to S1010 in Fig. 40 is first executed. The processing from S1000 
to S1 01 0 is exactly the same as the processing from S900 to S91 0 in foregoing Fig. 36. 

10 [0376] Next, processing proceeds to S1011, where an instantaneous value (present value at current time t) of the 
floor reaction force's moment allowable range is obtained based on the parameters of the floor reaction force's moment 
allowable range determined in S029 in foregoing Fig. 12. The floor reaction force's moment allowable range obtained 
is transmitted to the foregoing compensated total floor reaction force's moment distributor 1 1 0 (see Fig. 3). Thereafter, 
a present value (value at current timet) of the model manipulation floor reaction force's moment calculated by foregoing 

15 Equation d26 in the distributor 110 is given to the gait generating device 100. 

[0377] Next, the processing of the gait generating device 1 00 proceeds to S1 01 2, where body horizontal acceleration 
and body posture angular acceleration of the current time gait are determined so that the model manipulation floor 
reaction force's moment given from the compensated total floor reaction force's moment distributor 110 is generated 
about the desired ZMP. Note that the body horizontal acceleration and body posture angular acceleration are deter- 

20 mined to prevent the floor reaction force's horizontal component Fx from exceeding the floor reaction force's horizontal 
component allowable limit [Fxmin, Fxmax] determined in S608 in Fig. 32. 

[0378] In other words, the body horizontal acceleration and body posture angular acceleration of the current time 
gait are determined so that the moment acted about the desired ZMP by the resultant force of the inertial force and 
gravity becomes a moment obtained by changing the sign of the model manipulation floor reaction force's moment. 
25 Note that the body horizontal acceleration and body posture angular acceleration are determined to prevent a force 
obtained by changing the sign of an inertial force's horizontal component from exceeding the floor reaction force's 
horizontal component allowable limit [Fxmin, Fxmax]. 

[0379] Specifically, in S1 01 2, the body horizontal acceleration and body posture angular acceleration are determined 
following the flowchart shown in Fig. 41 . Description thereof is as follows. First of ail, in S1100, it is determined whether 
30 or not the current time t is within the body inclination angle recovery period [Ta, Tb] described with respect to the 
processing of S612 in foregoing Fig. 33. in other words, it is determined whether or not the current time t is within a 
period during which the floor reaction force's vertical component and floor reaction force's horizontal component can 
be generated with sufficiently large magnitudes. 

[0380] If the determination result in S1100 is NO, processing proceeds to S1102. In S1102, obtained is a body hor- 

35 izontal acceleration octmp required to generate the model manipulation floor reaction force's moment about the desired 
ZMP at present time t when movement of the body translation mode is performed. For example, octmp is obtained by 
using foregoing Equation 03 related to the dynamic model in foregoing Fig. 1 0. To be more specific, accelerations of 
the supporting leg material particle 2m and free leg material particle 2m at current time k is obtained using time series 
values of the desi red foot position/posture obtained up to the current time k. At the same time, positions of the supporting 

40 leg material particle 2m and free leg material particle 2m are obtained using the (present) desired foot position/posture 
at the current time k. Further, the desired total center-of-gravity vertical position at the current time k is obtained by 
using the (present) desired floor reaction force's vertical component at the current time k, and the vertical position of 
the body material particle 24m is obtained from the vertical positions of the supporting leg material particle 2m and 
free leg material particle 2m as well as the desired total center-of-gravity vertical position . At the same time, the vertical 

45 acceleration of the body material particle 24m at the current time k is obtained using time series values of the desired 
body vertical position obtained up to the current time k. These values obtained above are then substituted for foregoing 
Equation 03, the model manipulation floor reaction force's moment is set as My in Equation 03, and d2Gby/dt2 of 
Equation 03 is set to be zero. The equation thus obtained is then solved for d2Xb/dt2, thus obtaining d2Xb/dt2 as the 
body horizontal acceleration octmp. Note that, by the use of a more rigorous dynamic, model , the body horizontal ac- 

50 celeration atmp may also be searchingly obtained, which causes the horizontal component of the floor reaction force's 
moment about the desired ZMP to be the model manipulation floor reaction force's moment. Moreover, in this embod- 
iment, the reference body posture is the vertical posture, and the body posture angular acceleration by the reference 
body posture is thus zero. Hence, the body horizontal acceleration atmp is obtained while setting the angular accel- 
eration of the body rotation mode to be zero. However, when the reference body posture trajectory parameters are set 

55 to change the reference body posture, and if the reference body posture angular acceleration at the current time k, 
defined by the parameters, is not zero, the angular acceleration of the body rotation mode is set to be the reference 
body posture angular acceleration which is not zero. The body horizontal acceleration atmp is then obtained by the 
use of the dynamic model. (For example, d26by/dt2 of Equation 03 is set to be the reference body posture angular 
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acceleration and the body horizontal acceleration octmp is obtained as in the case of the above ) 

[0381] Next, processing proceeds from S1104 to S1114, where processing same as that from S1004 to S1014 in 

foregoing Fig. 37 is executed. 

[0382] When the determination result in S1100 is YES, processing proceeds to S1116, where a pattern of a body 
fh° ™J "? ^° ment ZMp - converted va,ue (ZMPrec) is set. In S1 1 00, the ZMPrec pattern is set as a pattern of 
the ZMP-converted vale of body posture restoring moment (ZM Prec) set in S71 8 in Fig. 34, unlike the one in S1 01 6 
in I - ig , o / . 

[0383] Next processing proceeds to S1 1 1 8 and 1 1 20, where processing same as that of S1 01 8 and 31 020 in Fiq 
37 is executed. In this case, however, the ZMPrec pattern is not zero. Therefore, in general, the body posture angular 
acceleration p for body posture recovery obtained in S1 1 20 is not zero. 

[0384] Next, processing proceeds to S1122. In S1122, if movement of the body translation mode is performed ob- 
tained b a body horizontal acceleration atmp required to generate the model manipulation floor reaction force's moment 
about the desired ZMP at present time. This processing is the same as that of S11 02 

[0385] Next processing proceeds to S1 1 24 and S1 1 26, where processing same as that of S1 024 and S1 026 in Fiq 
37 is executed. Thus, processing of S1 012 in Fig. 40 is completed. 

[0386] After performing the processing of S1012 as above, processing proceeds to S1014 where the processina 
same as that of S914 in Fig. 36 is executed, thus determining a body horizontal position and a body posture angle 
specifically, present values of them at the current time t) of the current time gait. Thus, the processing of S030 in Fiq 
12 is completed. y " 

[0387] Next processing proceeds to S032, where movements of arms for canceling a spin force (for causing the 
floor reaction forces moment vertical component generated about the desired ZMP by movement of the robot 1 other 
than the arms movements to be nearly zero) are determined. Specifically, obtained is a floor reaction force's moment 
vertical component trajectory at the desired ZMP when the arms are not swung (precisely, a trajectory obtained by 
J"?! n i a S ' 9n ? instantaneous value of the vertical component trajectory of the moment acted on the desired 
ZMP by the resultant force of the gravity and inertial force of the robot 1 , in the case where a gait is generated without 
swings of arms). In other words, an instantaneous value of the floor reaction force's moment vertical component about 
the (instantaneous value of) desired ZMP is obtained, and this instantaneous value balances with the instantaneous 
value of the movement of the gait (excluding arm swinging movements) generated by the processing in S030 Further 
the instantaneous value of the floor reaction force's moment vertical component is divided by an equivalent inertia 
moment of arm swinging movement, thus obtaining angular accelerations of the arm swinging movements required 
for canceling the spin force. Supplementary if the arms are swung too much, the instantaneous value of the floor 
mST S mC T ent VertiCa ' com P° nent can be divided by a value larger than the equivalent inertia moment 
[0388] Next, each angular acceleration is second-order integrated, and then passed through a low-cut filter for ore- 
• venting the integral from being too large. The angle thus obtained is set as an arm swinging movement angle. Note 
hat, in the arm swinging movements, the right and left arms are swung to the front and back in the opposite directions 
to each other, in order not to change the center of gravity of both arms. It is also possible that the arm swinging 
movements for canceling the spin force are generated in the normal gait, and arm swinging movements in the current 
time gait are determined so as to continue to those of the normal gait. 

[0389] Next processing proceeds to S034, where the control cycle At is added to time t. Thereafter, processing 
returns to S01 4, and waits for timer interruption per control cycle. 

[0390] The above-described generation processing of the desired gait has been described, taking the running gait 
in foregoing Fig. 5 as an example. However, even when the walking gait of the robot 1 is generated, a desired qait can 
be generated as in the case of the above. In this case, the floor reaction force's vertical component trajecto iy (trajectory 
for one step) may be set to have a broken line-shaped pattern as shown in Fig. 42, for example. To be more specific 
in this example, the floor reaction force's vertical component trajectory for the walking gait during the two-leg supporting 
period ,s set to have a trapezoid shape which projects to the increasing side of the floor reaction force's vertical com- 
ponent (projects upward). During the one-leg supporting period, the floor reaction force's vertical component trajectory 
for the walking gait is set to have a trapezoid shape which projects to the decreasing side of the floor reaction force's 
vertical component (projects downward). In this case, it is preferred to determine heights C1 , C2 and the like of these 

Tt ra Z e t ° iff i0nS ° f thS f ' 00r r6aCti0n f ° rCe ' S vertical com P°nent trajectory in the following manner. By the use of 
the body height decision method (see Japanese Patent Laid-Open Publication No. Heisei 1 0-86080; more specifically 
the method and the like shown in Fig. 6ofthepublication)earlierproposedb y theapplicantofthe application concerned 
a body vertical position trajectory is obtained as a reference body vertical position trajectory. This body vertical position 
trajectory satisfies a predetermined geometrical condition (condition for preventing the respective legs 2 and 2 from 
being fully stretched) related to displacement of the joints (specifically, knee joints) of the legs 2 and 2 of the robot 1 
Thereafter, the heights C1 and C2 of two trapezoid portions of the floor reaction force's vertical component trajectory 
a e determined so that the characteristic amount (for example, a difference between maximum and minimum values) 
with respect to the form of the body vertical position trajectory matches the characteristic amount (for example a 



51 



1NSDOCID: <EP 



1475198A1 I > 



EP 1 475 198 A1 

difference between maximum and minimum values) of the aforementioned reference body vertical position trajectory. 
The body vertical position trajectory corresponds to the total center-of-gravity vertical position trajectory of the robot 1 
obtained by second-order integration of the floor reaction force's vertical component trajectory from the beginning to 
the end of the gait In this case, in the floor reaction force's vertical component trajectory forthe walking gait, an average 
value of the floor reaction force's vertical components within one cycle Is caused to almost coincide with the self weight 
of the robot 1 as in the case of setting the floor reaction force's vertical component trajectory for the running gait. 
r03911 The desired gait generation processing in the gait generating device 100 is performed as described so far 
and instantaneous values of desired body position/posture, desired foot position/posture, desired arm postures, desired 
ZMP and desired total floor reaction force are sequentially determined and outputted. In this case, as for the desired 
total floor reaction force, only a component (s) required for compliance control may be outputted. The desired ZMP is 
stated as an output though it is included in the desired total floor reaction force. This is because the desired ZMP is 
particularly important. Further, the model manipulation floor reaction force's moment is not outputted to the composite- 
compliance control device (portion surrounded by a dotted line in Fig. 4) as the desired floor reaction force. In other 
words, a desired floor reaction force which targets zero floor reaction force's moment about the desired ZMP is outputted 
from the qait generating device 1 00 to the compliance control. 

[0392] Operation 1 of the above-described embodiment is as follows. A movement of a desired gait is generated so 
that the model manipulation floor reaction force's moment is generated about the desired ZMP. At the same time, 
though the movement of a desired gait is controlled so that the model manipulation floor reaction force's moment is 
not added to the floor reaction force of the actual robot 1 . Therefore, an imbalance between the movement of the 
desired gait and the floor reaction force occurs commensurate with absence of the model manipulation floor reaction 
force's moment This is equivalentto that a floor reaction force's moment obtained by changing the sign of the model 
manipulation floor reaction force's moment is acted on the actual robot 1 , with regard to an effect of converging the 
difference between the body posture angle of the actual robot 1 and the body posture angle of the desired gait to zero. 
[03931 Specifically the gait of the actual robot 1 can be converged to the corrected desired gait by determining the 
model manipulation floor reaction force's moment as appropriate. In other words, the position of the actual robot 1 can 

[0394] ' Operation 2 is that the total recovering force is the sum of the moment obtained by changing the sign of the 
model manipulation floor reaction force's moment and the desired floor reaction force's moment for compliance control. 
In other words, the total recovering force is a difference between the desired floor reaction force's moment for compli- 
ance control and the model manipulation floor reaction force's moment. 

r0395] Moreover, Operation 3 is as follows. The model manipulation floor reaction force's moment can be any value 
without consideration of the range where the ZMP can exist. Thus, a very high posture recovering force can be gen- 

[0396] Note that Operations 1 , 2 and 3 are similar to those of the technology in Japanese Patent Laid-Open Publi- 
cation No Heisei 5-337849 earlier proposed by the applicant of the application concerned. 

[0397] Moreover, Operation 4 is as follows. The body translational acceleration of the body translation mode and the 
body posture angular acceleration of the body rotation mode are determined so thatthe floor reaction force's horizontal 
component does not exceed the floor reaction force's horizontal component allowable limit. Thus, the robot 1 can be 
prevented from slipping at time when a large floor reaction force's horizontal component cannot be generated, such 
as time immediately before lifting and immediately after landing of the leg 2 on the supporting leg side in the running 
gait. The robot 1 can also be prevented from slipping even when the robot 1 moves on a floor with a small coefficient 

of friction. u 
[0398] Further Operation 5 is as follows. The floor reaction force's horizontal component allowable limit is set to be 
zero durinq a period when the translation vertical component of the floor reaction force is zero, that is, a period when 
both legs do not contact the floor. Therefore, the posture is recovered automatically by the algorithm of this embodiment 
described above depending on the body rotation mode without depending on the body translation mode. Thus, the 
posture is recovered without depending on a f fictional force between the floor and the bottom of the foot Hence, a 
posture recovery effect acts even in the above period (floating period) in a different mannerfrom the method of merely 
correcting the body translation mode. Note that, during this period, the floor reaction force's horizontal component is 
generated to be zero. Thus, the total center-of-gravity horizontal acceleration of the gait becomes zero. 
[03991 Yet further Operation 6 is that the model manipulation floor reaction force's moment is not outputted to the 
compliance control as a desiredfloor reaction force, as described earlier. In otherwords, even when a gait is generated 
so that the model manipulation floor reaction force's moment is generated about the desired ZMP, a desired floor 
reaction force which targets zero floor reaction force's moment about the desired ZMP is given from the gait generating 
device 100 to the compliance control. Therefore, a floor reaction force control by the compliance control can be ap- 
propriately performed without interruption. To be more specific, occurrence of problems, such as lowering foot 22s 
oriqinal sense of contact with the floor and raising foot 22's bottom surface, can be prevented or suppressed 
[0400] Note that as described later, the desired floor reaction force's momentfor compliance control about the desired 



52 



-i— r\ 



H A~7C-i no A 1 I -> 



EP 1 475 198 A1 



ZMP is determined not to exceed the floor reaction force's moment allowable range. 

[0401] Operation 7 is as follows. A gait generated so that the moment generated about the desired ZMP becomes 
zero, is called an original gait. A gait generated so that the moment generated about the desired ZMP becomes the 
model manipulation floor reaction force's moment as this embodiment described above, is called a corrected gait The 
original gait and the corrected gait are usualiy different gaits. The original gait is set so as to approach gradually the 
normal gaiL Therefore, the corrected gaiL is usually a gait which does not gradually approach the normal gaiL 
[0402] However, immediaLeiy after completion of current time gait (corrected gait) generation, the processing from 
S020 to S028 is executed again. Therefore, the end state of the corrected gait is set as a new initial state of a new 
current time gait, and new current time gait parameters are determined so that the new current time gait gradually 
approaches the newly set normal gait. Thus, it is possible to continuously generate gaits with ensured stability (for a 
long period of time). 

[0403] Here, correspondence of the above-described first embodiment to the present invention is described The 
first embodiment corresponds to the foregoing first to fifteenth aspects of the invention. In this case in the first em- 
bodiment, the body posture angle of the robot 1 is equivalent to the state of the posture of the robot the floor reaction 
force's horizontal component is equivalenttothe variableto be limited, and the model manipulation floor reaction force's 
moment is equivalent to the correction manipulated variable of the desired floor reaction force. The compensated total 
floor reaction force's moment Mdmd is equivalent to the first required manipulated variable, and the floor reaction 
force's moment for compliance control is equivalent to the actual floor reaction force manipulated variable Further the 
model in Fig, 10 is used as the dynamic model, and the movement of the model includes the body translation mode 
and the body rotation mode. In addition, gait parameters are corrected as appropriate in accordance with the end state 
of the last time gait, by the processing of S028 in Fig. 12. 

[0404] Note that, in this embodiment, when the value of the compensated total floor reaction force's moment Mdmd 
is within the floor reaction force's moment allowable range, the model manipulation floor reaction force's moment is 
zero. However, the model manipulation floor reaction force's moment at this time may be set in accordance with a state 
quantity of the dynamic mode! in Fig. 1 0 (for example, the center of gravity of the robot, the position of the body material 
particle 24m, and the like on the dynamic model). 

[0405] Next, the second embodiment of the present invention is described with reference to Figs. 43 to 46 In the 
description of this embodiment, constituents or functional parts same as those of the first embodiment are denoted by 
the same reference symbols as those of the first embodiment to omit description thereof. 

[0406] The outline of this embodiment is that the original gait and the corrected gait are simultaneously generated 
The corrected gait is corrected to stabilize the posture of the actual robot 1 . At the same time, when there remains a 
margin even after the floor reaction force's moment required for posture recovery is generated by compliance control 
(when there is a margin of the floor reaction force's moment which can be generated about the desire ZMP) the 
corrected gait is determined using this margin to converge to the original gait as much as possible. 
[0407] A functional block diagram of the control unit 26 in this embodiment is shown in Fig. 43. In this embodiment 
the compensated total floor reaction force's moment Mdmd obtained by the posture stability control calculator 1 12 is 
inputted to the gait generating device 1 00. The compensated total floor reaction force's moment distributor 1 1 0 which 
determines the model manipulation floor reaction force's moment and the desired floor reaction force's moment for 
compliance control based on the Mdmd, is incorporated in the gait generating device 100. The desired floor reaction 
force's moment for compliance control is outputted from the gait generating device 100 to the composite-compliance 
operation determinator 1 04. Thereafter, the compensated total floor reaction force's moment distributor 110 within the 
gait generating device 1 00 performs processing more complicated than that of the first embodiment, as described later 
Functional configuration of the control unit 26 apart from the above is the same as that of the foregoing first embodiment 
[0408] Fig. 44 shows the main flowchart of processing of the gait generating device 100 in this embodiment 
[0409] In Fig. 44, from S201 0 to S2029, processing same as the processing from S01 0 to S029 of the main flowchart 
(Fig. 12) of the first embodiment is performed. As for the initialization in S800 of the flowchart in Fig. 35, a subroutine 
of S028 (S2028 in this embodiment), the current time gait initial state is obtained by converting the end state of the 
last corrected gait (gait finally outputted from the gait generating device 1 00) into the present supporting leg coordinate 
system. The end state of the original gait determined in S2030 is not used in S800. 

[0410] After the processing of S2029 is completed or when the determination result of S2016 is NO, processing 
proceeds to S2030, where instantaneous values (present values at time t) of the original gait are determined The 
original gait is a gait generated so that the floor reaction force's moment about the desired ZMP becomes zero 
[0411] This original gait is generated by an algorithm in which the subroutine processing of S030 in Fig 12 of the 
foregoing first embodiment is partially changed. Specifically, in S1102 and S1122 in Fig. 41 , the subroutine processing 
within S030 (to be specific, the subroutine processing of S1 012 in Fig. 40 which is the subroutine processing of S030) 
the model manipulation floor reaction force's moment is set to be zero (a horizontal component of the desired floor 
reaction force's moment about the desired ZMP is set to be zero), and then a body horizontal acceleration cctmp is 
obtained. Processing other than above may be the same as that of S030 in Fig. 12. 
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[0412] Next, processing proceeds to S2031 , where instantaneous values of the corrected gait are determined. Note 
that the corrected gait is a desired gait finally outputted from the gait generating device 1 00. 

[0413] The processing of S2031 is performed by the subroutine processing of Fig. 45, and detailed description thereof 

is provided hereinbelow. . 

[0414] First of all, from S21 00 to S21 1 f , processing same as the processing from S1 000 to S1 01 f in Fig. 40 described 

in the first embodiment is executed. , 
[0415] Next processing proceeds to S2112, where a model manipulation floor reaction force's moment, a desired 
floor reaction force's moment for compliance control, a body horizontal acceleration and body posture angular accel- 
eration are determined so as to satisfy the conditions of the floor reaction force's moment allowable range and floor 
reaction force's horizontal component allowable limit, 

[0416] Details of S2112 are described below using the flowchart in Fig. 46 which shows the processing of S2112. 
[0417] First of all, in S2200, a model-to-model body horizontal position difference is obtained. This is a difference 
between a body horizontal position of the corrected gait and a body horizontal position of the original gait, At this point, 
a present value (value at time t) of the body horizontal position of the corrected gait is not yet obtained. Therefore, in 
S2200 the model-to-model body horizontal position difference is calculated using the last value (value finally obtained 
in the control cycle of time t-At) of the body horizontal position of the corrected gait and the last value (value obtained 
in S2030 in the control cycle of time t-At) or the present value (value obtained in S2030 in control cycle of time t) of 
the body horizontal position of the original gait. 

[041 8] Next processing proceeds to S2202, where a model-to-model body posture angle difference is obtained. This 
is a difference between a body posture angle of the corrected gait and a body posture angle of the original gait. In 
S2202 similarly to the calculation processing of the model-to-model body horizontal position difference in S2200, the 
last value of the body posture angle of the corrected gait and the last value or present value of the body posture angle 
of the original gait are used to obtain the model-to-model body posture angle difference. 

[0419] Next processing proceeds to S2204, where a required value of model's body horizontal position stabilization 
floor reaction force's moment Mpfdmd is determined based on the model-to-model body horizontal position difference. 
Mpfdmd is required to converge the model-to-model body horizontal position difference to zero, If a floor reaction force's 
moment for generating a body horizontal acceleration of the body translation mode of the corrected gait is merely 
caused to coincide with a floor reaction force's moment generating body horizontal acceleration of the body translation 
mode of the original gait, the model-to-model body horizontal position difference diverges. When a movement is per- 
formed by the aforementioned body translation mode so as to return the body horizontal position of the corrected gait 
to the body horizontal position of the original gait, a floor reaction force's moment is generated by the movement. From 
this floor reaction force's moment, a floor reaction force's moment generating a body horizontal acceleration of the 
body translation mode of the original gait is subtracted. The resulting moment is defined as the meaning of the required 
value of model's body horizontal position stabilization floor reaction force's moment Mpfdmd, 

[0420] Specifically the required value of model's body horizontal position stabilization floor reaction force's moment 
Mpfdmd is determined by, for example, a feedback control law of the following equation. In this example, a PD control 
law is used as the feedback control law, but other feedback control law, such as PID, may be used as well. 

Mpfdmd = Kmp*model-to-model body horizontal position difference 
+ Kmpv*time differential of model-to-model body horizontal 

position difference Equation d28 

where Kmp and Kmpv are feedback gains (proportional gain, differential gain). 

[0421] Next processing proceeds to S2206, where a required value of model's body posture angle stabilization floor 
reaction force's moment Mrfdmd is determined based on the model-to-model body posture angle difference. Mrfdmd 
is required to cause the model-to-modei body posture angle difference to converge to zero. If a floor reaction force's 
moment generating a body posture angular acceleration of the body rotation mode of the corrected gait is merely 
caused to coincide with a floor reaction force's moment generating a body position angular acceleration of the body 
rotation mode of the original gait, the model-to-model body posture angle difference does not converge to zero. When 
a movement is performed by the body rotation mode so as to return the body posture angle of the corrected gait to the 
body posture angle of the original gait, a floor reaction force's moment is generated by the movement. From this floor 
reaction force's moment, a floor reaction force's moment generating a body position angular acceleration of the body 
rotation mode of the original gait is subtracted. The resulting moment is defined as the required value of model's body 
posture angle stabilization floor reaction force's moment Mrfdmd. 

[0422] Specifically, the required value of model's body posture angle stabilization floor reaction force's moment Mr- 
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fdmd is determined by, for example, a feedback control law of the following equation. In this example, a PD control law 
is used as the feedback control law, but other feedback control law, such as PID, may be used as well. 

Mrfdrnd = Kmr*mode!-to-model body posture angle difference 
+ Krnrv*time differential of model-to-model body posture angle 

difference Equation d29 

where Kmr and Kmrv are feedback gains (proportional gain, differential gain). 

[0423] Incidentally, the floor reaction force's moment generating the body horizontal acceleration of the body trans- 
lation movement mode of the original gait is subtracted from the floor reaction force generated due to the body trans- 
lation movement mode of the finally determined corrected gait. The resultant moment is referred to as a model's body 
horizontal position stabilization floor reaction force's moment. In addition, the floor reaction force's moment generating 
body posture angular acceleration of the body rotation movement mode of the original gait is subtracted from the floor 
reaction force's moment generated due to the body rotation movement mode of the finally determined corrected gait 
The resultant moment is referred to as a model's body posture angle stabilization floor reaction force's moment 
[0424] Meanwhile, linearity approximately holds between a perturbation movement and a perturbation floor reaction 
force. In other words, when different perturbation movements are added to a movement of the original gait movements 
thus obtained generate floor reaction forces. These floor reaction forces are almost the same as floor reaction forces 
obtained by adding perturbation floor reaction forces generated by the above perturbation movements to a floor reaction 
force of the original gait. Hence, the following equation holds, approximately. 



Model manipulation floor reaction force's moment 
= model's body horizontal position stabilization floor reaction 
30 force's moment 

+ model's body posture angle stabilization floor reaction force's 

moment Equation d30 



[0425] Therefore, if the model's body horizontal position stabilization floor reaction force's moment is determined to 
coincide with or to be as close as possible to the required value of model's body horizontal position stabilization floor 
reaction force's moment Mpfdmd, and if the model's body posture angle stabilization floor reaction force's moment is 
determined to coincide with or to be as close as possible to the required value of model's body posture angle stabilization 
floor reaction force's moment Mrfdrnd, under consideration that Equation d30 approximately holds true, it is possible 
that an appropriate model manipulation floor reaction force's moment is generated to the corrected gait, and at the 
same time, the body horizontal acceleration and body posture angular acceleration of the corrected gait are converged 
to the body horizontal acceleration and body posture angular acceleration of the original gait, respectively as much 
as possible. 

[0426] Thus, after S2206, processing proceeds to S2208, and the model's body horizontal position stabilization floor 
reaction force's moment (floor reaction force's moment of body translation mode) and the model's body posture angle 
stabilization floor reaction force's moment (floor reaction force's moment of the body rotation mode) are determined 
so as to satisfy conditions below (conditions referred to as recovery conditions) as much as possible. Further, body 
horizontal acceleration and body posture angular acceleration of the corrected gait are determined to satisfy definitions 
of the foregoing model's body horizontal position stabilization floor reaction force's moment and model's body posture 
angle stabilization floor reaction force's moment. Note that the recovery conditions shown below have, in descending 
order, higher priorities. This means that, where some conditions are mutually contradictory and thus cannot be satisfied 
at the same time, each such condition has, in descending order, a priority to be satisfied (to hold true) However 
recovery conditions 1 and 2 are always satisfied (always hold true). 

[0427] (Recovery condition 1 )The sum of the compensated.total floor reaction force's moment Mdmd and the model 
manipulation floor reaction force's moment (equivalent to the desired floor reaction force's moment for compliance 
control when foregoing Equation d27 holds true) shall not exceed the floor reaction force's moment allowable range 
[0428] (Recovery condition 2) The floor reaction force's horizontal component of the corrected gait shall not exceed 
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the floor reaction force's horizontal component allowable limit. 

[0429] (Recovery condition 3) The model's body posture angle stabilization floor reaction force's moment shall co- 
incide with or be as close as possible to the required value of model's body posture angle stabilization floor reaction 
force's moment Mrfdmd. This condition is for convergence of the body posture angle of the corrected gait to the body 

5 posture angle of the original gait (initially planned gait). 

[0430] (Recovery condition 4) The model's body horizontal position stabilization floor reaction force's moment shall 
coincide with or be as close as possible to the required value of model's body horizontal position stabilization floor 
reaction force's moment Mpfdmd. This condition is for convergence of the body horizontal position of the corrected 
gait to the body horizontal position of the original gait (initially planned gait). 

10 [0431 ] (Recovery condition 5) The model's body posture angle stabilization floor reaction force's moment and model's 
body horizontal position stabilization floor reaction force's moment are continuous, individually. 
[0432] The processing of S2208 determines the body horizontal acceleration, body posture angular acceleration and 
the like which satisfy the above recovery conditions 1 to 5. For example, this processing is specifically executed as 

• follows. , 
15 [0433] First of all, the required floor reaction force's moment for compliance control is caused to coincide with the 
sum of the compensated total floor reaction force's moment Mdmd, the foregoing required value of model's body hor- 
izontal position stabilization floor reaction force's moment Mpfdmd, and the required value of model's body posture 
angle stabilization floor reaction force's moment Mrfdmd. In this case, the provisional value of the desired floor reaction 
force's moment for compliance control (= Mdmd + Mpfdmd + Mrfdmd, denoted by Reference Symbol Min in the de- 
20 scription of this embodiment) is obtained. Min means a basic required value of the desired floor reaction force's moment 
for compliance control. 

[0434] Further, when a movement of a gait is generated under the assumption that Mpfdmd is generated by the body 
translation mode and Mrfdmd is generated by the body rotation mode, a floor reaction force's horizontal component is 
generated on the dynamic model of foregoing Equations 02 and 03. This floor reaction force's horizontal component 

25 \ s obtained as a provisional value Fin. Fin has a meaning of a required value of the floor, reaction force's horizontal 
component by the required value of model's body horizontal position stabilization floor reaction force's moment Mpfdmd. 
This provisional value Fin of the floor reaction force's horizontal component can be obtained by, for example, a method 
similar to that of S1 102 and S1 104 in Fig. 41 described in the foregoing first embodiment. More specifically, My on the 
leftside of Equation 03 is set as (Mpfdmd + Mrfdmd). (Precisely, My is set as a value obtained by adding a reference 

30 value of the floor reaction force's moment about the desired ZMP to Mpfdmd + Mrfdmd. However, the reference value 
is zero in this embodiment.) At the same time, J*d26by/dt2 on the right side of Equation 03 is set as Mrfdmd. The 
equation thus obtained is solved for d2Xb/dt2. Thus, the horizontal' acceleration of the body material particle 24m, and 
thus the body horizontal acceleration (equivalent to cctmp in S1102) is obtained. Thereafter, based on foregoing Equa- 
tion 17, the provisional value Fin (equivalent to Fxtmp in Equation 17) of the floor reaction force's horizontal component 

35 is obtained using the body horizontal acceleration obtained above. 

[0435] Next, a group of Min and Fin is compared with a group of the floor reaction force's moment allowable range 
(specifically, the present value of the allowable range obtained in S2111 in Fig. 45 in the control cycle at current time 
t) and the floor reaction force's horizontal component allowable limit (specifically, the present value of the allowable 
range obtained in S21 1 0 in Fig. 45 in the control cycle at current time t). Thereafter, determined is a group of the desired 

40 floor reaction force's moment for compliance control and the floor reaction force's horizontal component, which satisfy 
the above limitations of allowable range, respectively (specifically, a group of the desired floor reaction force's moment 
for compliance control which remains within the floor reaction force's moment allowable range, and the floor reaction 
force's horizontal component which remains within the floor reaction force's horizontal component allowable limit). 
Strictly speaking, limited by the floor reaction force's moment allowable range is a value obtained by adding the desired 

45 floor reaction force's moment for compliance control to the reference value (reference instantaneous value) of the floor 
reaction force's moment about the desired ZMP. However, in this embodiment, the reference value is zero. Therefore, 
the desired floor reaction force's moment for compliance control is directly limited by the floor reaction force's moment 
allowable range. 

[0436] Here, the group of the desired floor reaction force's moment for compliance control (hereinafter, referred to 
so as controlled desired floor reaction force's moment for compliance control Mltd) and floor reaction force's horizontal 
component (hereinafter, referred to as controlled floor reaction force's horizontal component Fltd), which satisfy the 
above limitations of allowable range, is determined by a method same as a method to be detailed in the later-described 
third embodiment using Figs. 52 to 55. Therefore, details of the method are described in the third embodiment. In the 
following description of this embodiment, the method is briefly explained with reference to Figs. 52 to 55. 
55 [0437] As shown in Figs. 52 to 55, when it is assumed that the floor reaction force's moment and floor reaction force's 
horizontal component are two axes of a coordinate plane, the group of the floor reaction force's moment allowable 
range and floor reaction force's horizontal component allowable limit is expressed as a rectangular region shown in 
the drawings (hereinafter, referred to as a allowable range region in this description). When the group of (Fin, Min) 
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(white circle in the drawing) is within the above-mentioned allowable range region as shown in Fiq 52 Fin itself is 
determined as the floor reaction force's horizontal component Fltd which satisfies the limitation of the floor reaction 
force s horizontal component allowable limit, and Min itself is determined as the desired floor reaction force's moment 
for compliance control Mltd which satisfies the limitation of the floor reaction force's moment allowable ranae like the 
group (Fltd, Mltd) expressed by a black circle in the drawing. anowaoie range, l.ke the 

[0438] Further, when the group of (Fin, Min) (white circle in the drawing) deviates from the above-mentioned allowable 
range region as shown in Figs. 53 to 55, it is prioritized that a model's body posture angle stabilization floor reaction 

m!l e H to n Af tai K ed by „ USin9 „ later - described Ec ^°ns *01 and e02 from the group of (Fltd, Mltd) finally deter- 
mined to satisfy the above allowable range region, coincides with or become closest to the required value of model's 
body posture angle stabilization floor reaction force's moment Mrfdmd. Based on this, the group of (Mltd Fltd) is de- 
termined so that the model body horizontal position stabilization moment becomes closest to the required value of 
model s body horizontal position stabilization moment Mpfdmd. This is for satisfying the foregoing recovery conditions 

[04391 ♦ ' e ' 9r ° UP ° f (F ' td ' M ' td) 88 ab ° Ve fe determine d as follows. A ratio of a floor reaction force's 

moment AMp and floor reaction force's horizontal component AFp (=AMp/AFp), both generated by the foregoing body 
translation mode, js referred to as a body translation mode floor reaction force ratio h. Assume a following line that has 
an inclination of the body translation mode floor reaction force ratio h and passes a point (Fin Min) on the coordinate 
plane of each of Figs. 53 to 55. Note that the body translation mode floor reaction force ratio h is a value defined by h 

:t, Z ? ( ^ ei9ht ° f the body material P ?rticle 24m from the de sired ZMP), based on foregoing Equations 06 arid 07 
0440] As shown in each of Figs. 53 and 54, where are intersection points between the line having the aforementioned 
inclination h and he aforementioned allowable range region (rectangular regions in each drawing), (Fltd Mltd) are 
determined as values of the floor reaction force's horizontal component and floor reaction force's moment which cor- 
respond to an intersection point (black circle in the drawings) closest to the point of (Fin, Min) among the above- 
mentioned intersection points. When the group of (Fltd, Mltd) is determined in this manner, it is priori£ed that the 
model s body posture angle stabilization floor reaction force's moment obtained by the use of later-described Equations 
mhL i ? c °'ncides with the.required value of model's body posture angle stabilization floorreaction force's moment 
Mrfdmd. Based on this the model's body horizontal position stabilization floor reaction force's moment becomes closest 
to the required value of model's body horizontal position stabilization floor reaction force's moment Mpfdmd. Note that 
this principle will be detailed in the third embodiment described later. 

[0441] Moreover, as shown in Fig. 55, when the line having the inclination h and passing the point (Fin Min) (white 
oU^nrlZ'" 9 ! d ° eS n K ° tintersect with *e foregoing allowable range region, (Fltd, Mltd) are determined as values 
of the floor react on force s horizontal component and floor reaction force's moment which correspond to an intersection 
point (black circle in the drawing) between the foregoing allowable range region and a line. This line is one of the lines 
having the same inclination h and intersecting with the foregoing allowable range region and is the closest line to the 
hne having the inclination h and passing through the point (Fin, Min). When the group of (Fltd, Mltd) is determined as 
J 'I S dy P ° StUre ang ' e stabilization f loor taction force's moment obtained by later-described Equations 

♦ ! S ^ 0t C ° inCide With the reqUired Va ' Ue 0f model ' s bod y P° sture angle stabilization floor reaction force's 

moment Mrfdmd, but it is prioritized to be closest to the Mrfdmd. Based on this, the model's body horizontal position 
s tab. ization oor reaction force's moment becomes closest to the required value of model's body horizontal position 
stabHization floor reaction force's moment Mpfdmd. Note that this principle will also be detailed in the third embodiment 
described later. 

[0442] It is also possible to searchingly obtain the group of (Fltd, Mltd), which satisfies the foregoing recovery con- 
ditions 3 and 4, based on foregoing Equations 02 and 03. 

[0443] After the group of (Fltd, Mltd) is obtained as described above, determined are the above-mentioned model's 
body horizontal position stabilization floor reaction force's moment, that is, the floor reaction force's moment to be 
generated by the body translation mode, and the above-mentioned model's body posture angle stabilization floor re- 
™Z Tl moment ' that is ' tne floor reac ti°n force's moment to be generated by the body rotation mode 
[0444] In this case, the model's body horizontal position stabilization floor reaction force's moment is determined bv 
for example, the following equation. y ' 

Model's body horizontal position stabilization floor reaction 

force's moment 

= Mpfdmd + Mltd - Min + h* (Fltd - Fin) Equation e01 

[0445] Moreover, the model's body posture angle stabilization floor reaction force's moment is determined by, for 
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example, the following equation. 

Model's body posture angle stabilization floor reaction force's 

moment 

• = Mrfdmd - h*(Fltd - Fin) Equation e02 

[0446] Next, a present value (value at time t) of the body horizontal acceleration and a present value (value at time 
t) of the body posture angular acceleration are determined. In this case, Fx on the left side of foregoing Equation 02 
is set as Fltd, and the equation thus obtained is solved for d2Xb/dt2, obtaining a horizontal acceleration of the body 
material particle 24m. The body horizontal acceleration is determined from this horizontal acceleration of the body 
material particle 24m. The body posture angular acceleration is obtained by, for example, dividing the model's body 
posture angle stabilization floor reaction force's moment obtained as above by the foregoing body inertia moment J. 
Alternatively the body posture angular acceleration can be obtained in the following manner, for example. My on the 
left side of Equation 03 is set as the sum of the model's body horizontal position stabilization floor reaction force's 
moment and the model's body posture angle stabilization floor reaction force's moment obtained as above. At the same 
time d2Xb/dt2 in the second term on the right side of Equation 03 is set as the (present value of) horizontal acceleration 
of the body material particle 24m obtained as above. The equation thus obtained is solved for d2Gby/dt2, thus obtaining 
the body posture angular acceleration. In this case, a present value of the body horizontal position, which corresponds 
to Xb (horizontal position of the body material particle 24m) in the first term on the right side of Equation 03, is not 
obtained yet Yet, Xb, which corresponds to the last value (value obtained in the control cycle of time t-At) of the body 
horizontal position, can be used, for example. Alternatively, the body horizontal acceleration is second-order integrated 
up to the current time t by using the present value of the body horizontal acceleration obtained as above. Thus, the 
present value of the body horizontal position is obtained. The horizontal position of the body material particle 24m, 
corresponding; to the above present value of the body horizontal position, may be used as Xb. 
[0447] By the processing described above, the model's body horizontal position stabilization floor reaction force's 
moment and model's body posture angle stabilization floor reaction force's moment are determined to satisfy the fore- 
going recovery conditions 1 to 5. In addition, the body horizontal acceleration and body posture angular acceleration 
are determined. 

[0448] After executing the processing of S2208 as above, processing proceeds to S2210, where the model manip- 
ulation floor reaction force's moment is determined by foregoing Equation d30. In other words, the sum of the model's 
body horizontal position stabilization floor reaction force's moment and model's body posture angle stabilization floor 
reaction force's moment, obtained in S2208, is determined as the model manipulation floor reaction force's moment. 
Note that the floor reaction force's moment about the desired ZMP may be calculated based on the present instanta- 
neous value of the movement of the finally determined corrected gait, and the resulting value may be set as the model 
manipulation floor reaction force's moment. 

[0449] Next, processing proceeds to S2212, where the desired floor reaction force's moment for compliance control 
is determined by foregoing Equator 

Mdmd and the model manipulation floor reaction force's moment obtained in S2210 is determined as the desired floor 
reaction force's moment for compliance control. 

[0450] Processing of S2112 in Fig. 45 is thus completed. Next, processing proceeds to S2114. The processing of 
S2114 is the same as the processing of S1 014 in Fig. 40 in the foregoing first embodiment. The present value of the. 
body horizontal position is determined by second-order integration of the body horizontal acceleration, and the present 
value of the body posture angle is determined by second-order integration of the body position angular acceleration. 
[0451] Next, processing proceeds to S2032 and S2034 in Fig. 44, where processing same as that of S032 and S034 
in Fig 12 is executed, and gait generation processing is repeated. 

[0452] Supplementary; in determining gait instantaneous values by the dynamic model in this embodiment, a state 
of the dynamic model (or instantaneous values of the last time gait and the gait before the last time gait) is also required. 
Thus, two dynamic models for generating the corrected gait and the original gait are needed. 

[0453] As described above, in this embodiment, the original gait and corrected gait are generated in parallel. The 
corrected gait is corrected to stabilize the posture of the actual robot 1 . At the same time, if there remains a margin 
even after a floor reaction force's moment required for posture recovery is generated by the compliance control, the 
corrected gait is converged into the original gait using the margin, as much as possible. Therefore, in addition to the 
operational advantages of the foregoing first embodiment, it is possible to generate a gait close to the initially set 
original gait that is, a gait close to a gait faithfully generated as initially required. Thus, where there is a movement 
path set in advance, it is possible to prevent a large deviation from the movement path. In addition, convergence of 
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the body posture angle of the corrected gait to the body posture angle of the original gait (initially determined gait) is 
prioritized over convergence of the body horizontal position of the corrected gait to the body horizontal position of the 
original gait (initially determined gait) (a movement of body translation mode is adjusted as much as possible within a 
range where the floor reaction force's horizontal component allowable limit is satisfied). Thus, a large fluctuation of the 
body posture angle can be suppressed. 

[0454] Here, correspondence of the second embodimenl described above to the present invention is described The 
second embodiment corresponds to the foregoing first to fourteenth aspects, and the sixteenth to twenty-third aspects 
of the present invention. In this case, in the second embodiment, the body posture angle of the robot 1 is equivalent 
to the state quantity of the posture of the robot, the floor reaction force's horizontal component is equivalent to the 
variable to be limited, the model manipulation floor reaction force's moment is equivalent to the correction manipulated 
variable of the desired floor reaction force, the compensated total floor reaction force's moment Mdmd is equivalent to 
the first required manipulated variable, the floor reaction force's moment for compliance control is equivalent to the 
actual floor reaction force manipulated variable, and the required value of model's body horizontal position stabilization 
floor reaction force's moment Mpfdmd and the required value of model's body posture angle stabilization floor reaction 
force's moment Mrfdmd are equivalent to the second required manipulated variable. Further, the model in Fig 10 is 
used as the dynamic model, and the movement of the model includes the body translation mode and body rotation 
mode. Furthermore, the gait parameters are corrected as appropriate in accordance with the state of the corrected 
gait, in the processing of S2028 in Fig. 44. 

[0455] Next, the third embodiment of the present invention is described with reference to Figs 47 to 55 In the 
20 description of this embodiment, constituents or functional parts same as those in the first or second embodiment are 
denoted by the same reference symbols as those of the first or second embodiment to omit description thereof 
[0456] In this embodiment, the functional configuration of the control unit 26 is the same as that of the foregoinq 
second embodiment, in other words, the configuration shown in Fig. 43 described earlier. However in this embodiment 
the algorithm for gait generation executed by the gait generating device 100 is different from that of the foregoinq 
second embodiment. The processing of each portion other than the gait generating device 1 00 is the same as that of 
the foregoing second embodiment. 

[0457] Fig. 47 is a block diagram showing an outline of the processing by the- gait generating device 100 in this 
embodiment. The outline of the processing by the gait generating device 1 00 is described below with reference to Fiq 
47. The outline of the processing described below using Fig. 47 is the same in thefourth to sixth embodiments described 
30 later. 

[0458] As shown in the drawing, the gait generating device 1 00 includes a gait parameter determinator 100a The 
gait parameter determinator 1 00a determines values or a time series table of parameters of a desired gait (parameters 
defining the desired gait). This Is equivalent to processing from S3018 to S3030 of the flowchart in Fig 48 described 
later. a ' 

35 [0459] Though details are given later, the parameters determined by the gait parameter determinator 1 00a include 
parameters defining desired foot position/posture trajectories, desired ann posture trajectories, reference body posture 
trajectory, desired ZMP trajectory, desired floor reaction force's vertical component's trajectory, and the like as well as 
parameters definlngfloor reaction force's horizontal component allowable limit and parameters defining ZMP allowable 
range. In this case, there are two kinds of floor reaction force's horizontal component allowable limits set in this em- 
bodiment, one for a simplified model's gait, set in processing of S3026 described later, and the other one for qait 
correction, set in S3030. Meanwhile, the ZMP allowable range is only one kind, solely for gait correction set in the 
processing of S3030. 

[0460] Here, the ZMP allowable range corresponds to the floor reaction force's moment allowable range in this em- 
bodiment, and is set as described in the foregoing first embodiment with reference to Fig 39 
« [0461] The gait parameters determined in the gait parameter determinator 1 00a are inputted to a desired instanta- 
neous value generator 1 00b. Based on the gait parameters inputted, the desired instantaneous value generator 1 00b 
sequentially calculates (generates) the instantaneous values of desired foot position/posture, desired ZMP desired 
floor reaction force's vertical component, desired arm postures, desired total center of gravity vertical position' desired 
body vertical position, floor reaction force's horizontal component allowable limit, ZMP allowable range and reference 
•o body posture angle, at current time t. (In Fig. 47, only a part of these desired instantaneous values is stated ) This 
processing by the desired instantaneous value generator 100b is equivalent to the processing from S1 000 to S1 01 0 
in Fig. AO executed within the processing of S3032 of the flowchart in Fig. 48 described later, as well as the processing 
of S3034 and S3036 in Fig. 48. Note that, in this embodiment, among the desired instantaneous values calculated by 
the desired instantaneous value generator 100b, a part of those instantaneous values (specifically, the instantaneous 
value of desired body vertical position) is a provisional value and will be corrected later. Further, the instantaneous 
values of the floor reaction force's horizontal component allowable limit calculated by the desired instantaneous value 
generator 1 00b includes an instantaneous value for the simplified model's gait, and an instantaneous value for qait 
correction. " ' M 
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[04621 The desired instantaneous values (part of which are provisional instantaneous values) calculated (generated) 
by the desired instantaneous value generator 1 00b are inputted to a full-model correction unit 1 00c. The compensated 
total floor reaction force's moment Mdmd, obtained In the posture stability control calculator 112 (see Fig. 43), is also 
inputted to the full-model correction unit 100c. The full-model correction unit 100c includes a simplified model 100c1 
and a full model 1 00c2, as dynamic models. The full-model correction unit 1 00c determines provisional instantaneous 
values or the like of the desired body position/poslure from the inputted values, based on the simplified model 100c1 . 
Further, the full-model correction unit 100c corrects the determined provisional instantaneous values or the like of the 
body position/posture, by the use of the full model 100c2, ,,.,.„ , 

[0463] Note that, a configuration is also feasible where the simplified model 1 00c1 is not included in the full-model 
correction unit 1 00c2. The full model 1 00e2 includes any one of an inverse full model (inverse dynamic full model) and 
a direct full model (direct dynamic full model), as described later. 

[0464] Basically, the full-model correction unit 1 00c executes processing (B) to satisfy the following conditions A1 to 
A3 In other words, the full-model correction unit 100c corrects the body position/posture of the simplified model's gait 
determined by using the simplified model, and outputs the desired floor reaction force's moment for compliance control 
about the desired ZMP (B), so that (A1) the dynamic equilibrium conditions are satisfied more accurately than a gait 
generated based on only the simplified model (hereinafter, referred to as a simplified model's gait) does; (A2) a true 
ZMP (ZMP which satisfies the original definition, corrected by generating a desired floor reaction force's moment for 
compliance control about the desired ZMP) exists within the ZMP allowable range (allowable range capable of suffi- 
ciently maintaining the stability margin); and (A3) the floor reaction force's horizontal component remains with.n the 
floor reaction force's horizontal component allowable limit for gait correction. , , J711D ' 

[0465] The above condition (A2) is equal to that the floor reaction force's moment generated about the desired ZMP 
remains within the floor reaction force's moment allowable range corresponding to the ZMP allowable range 
[0466] Here the aforementioned simplified model 1 00c1 and full model 1 00c2 are described. The simplified model 
100c1 is a dynamic model which prioritizes a reduction of calculation amount and easy analysis of behavior than 
dynamic accuracy. Thus, the simplified model may be a model in which partially neglected variables (for example 
anqular momentum about the total center of gravity is neglected) and a contradiction (i.e., lack of stringency) with 
regard to dynamics exist. In this embodiment, the dynamic model in Fig. 10 (dynamic model described by foregoing 
Equations 01 to 05) described in the foregoing first embodiment is used as the simplified model 1 00c1 . 
[0467] The full model 1 00c2 means a robot dynamic model different from the simplified model 1 00c1 . It is preferred 
that the full model 1 00c2 be a robot dynamic model having higher approximation accuracy than that of the simplified 
model 1 00d This is explained by using illustrated examples. As described above, the dynamic model depicted in Hg. 
1 0 is used as the simplified model 1 00c1 in this embodiment. Therefore, it is preferred that a robot dynamic model like, 
for example the model with multiple material particles shown in Fig. 11 (a model having a material particle in each 
link) which has higher approximation accuracy than that of the dynamic model in Fig. 10, be used as the full model 
100c2 In this case, an inertia moment may be set about each material particle in this full model 1 00c2. 
[0468] However, the simplified model 100c1 and full model 100c2 need not be always different in approximation 
accuracy The simplified model 100c1 and full model 1 00c2 may have the same dynamic equation, but have different 
floor reaction force's horizontal component allowable limits. In other words, a difference between the allowable range 
for the simplified model's gait and allowable range for gait correction may be the only difference between them. For 
example it is sufficient that a floor reaction force's horizontal component allowable limit is set large (can even exceed 
the friction limit) when generating the gait using the simplified model 1 00c1 , and is set narrow in order to prevent slip 
when correcting the gait using the full model 100c2. 

[04691 Note that in this description, a model used for calculating (outputting) body position/posture based on (by 
inputting) desired foot position/posture and desired floor reaction force (desired ZM P and desired floor reaction force's 
vertical component, in particular), is referred to as a "direct dynamic model." A model used for calculating (outputting) 
a floor reaction force (a desired ZMP or floor reaction force's moment about the desired ZM P and floor reaction force s 
horizontal component, in particular) based on (by inputting) the desired foot position/posture, desired body posture 
and desired body position, is referred to as an "inverse dynamic model." The inputs to the direct dynamic model include 
at least a desired floor reaction force, and the inputs to the inverse dynamic model include at least a desired movement 
[04701 The full model 1 00c2 included in the full-model correction unit 1 00c is provided with the inverse dynamic full 
model (often abbreviated as an "inverse full model") or the direct dynamic full model (often abbreviated as a "direct full 
model"). In general, an amount of calculation is apt to be larger in a direct dynamic model than in an inverse dynamic 

[0471] The above then being the outline of the processing by the gait generating device 1 00. 
[0472] Next the processing by the gait generating device 100 in this embodiment is described in detail. The gait 
generating device 1 00 in this embodiment executes processing shown in a flowchart in Fig. 48 to generate a gait 
[04731 First of all from S3010to S3028, processing same as the processing from S010to S02B in Fig. 12 described 
n the foregoing first embodiment is executed. The floor reaction force's horizontal component allowable limit of the 
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current time gait, determined in S608 in Fig. 32 that is the subroutine of S3026, may be set without considering the 
f notional force limit so rigorously as in the foregoing first and second embodiments, and may be set as a range exceeding 
the frictional force limit. This is because later-described full model correction ultimately limits the floor reaction force's 
horizontal component by the floor reaction force's horizontal component allowable limit for gait correction. 
[0474] Next, processing proceeds to S3030, where parameters are determined for respectively defining the floor 
reaction force's horizontal component allowable limit for gaiL correction and the ZMP allowable range (allowable range 
of floor reaction force central point). In this cas e! for example, similarly Lo the floor reaction force's horizontal component 
allowable limit for the aforementioned simplified model's gait, the floor reaction force's horizontal component allowable 
limit for gait correction is set to have a pattern like the one shown in foregoing Fig. 33 for each of X-axis direction (f ront- 
and-back direction) and Y-axis direction (right-and-left direction), based on the floor reaction force's vertical component 
trajectory and foregoing Equation 12. Further, for example, the value of ka> in foregoing Equation 12 is set as a 
parameter defining the floor reaction force's horizontal component allowable limit for gait correction, However, it is 
preferred that the floor reaction force's horizontal component allowable limit be surely set within a range of the friction 
limit by setting the value of the coefficient ka in Equation 12 to be somewhat smaller than that of the floor reaction 
force's horizontal component allowable limit for the simplified model's gait, or the like. 

[0475] Moreover, the ZMP allowable range is set similarly to the description regarding setting of the floor reaction 
force's moment allowable range in S029 in Fig. 12 of the foregoing first embodiment. Of course, the ZMP allowable 
range may be converted into the equivalent floor reaction force's moment allowable range by multiplying the ZMP 
allowable range by the floor reaction force's vertical component. 

[0476] Next, processing proceeds to S3032, where current time gait instantaneous values (values at current time t) 
are determined by the use of the foregoing simplified model (dynamic model in Fig, 1 0). The processing of S3032 is 
the same as the processing of S030 in Fig. 12 in the first embodiment, except for a part of the processing. To be more 
specific, in the processing of S3032, the.current time gait instantaneous values are determined where the model ma- 
nipulation floor reaction force's moment is set to be zero, in other words, so that the floor reaction force's moment 
generated about the desired ZMP becomes zero. In short, in the processing of S3032, the processing of S1102 and 
S 11 22 in Fig. 41 , that is the subroutine processing within the processing of S3032, is executed where the model ma- 
nipulation floor reaction force's moment is set to be zero. Apart from this, the processing of S3032 is the same as the 
processing of S030 of the first embodiment. 

[0477] Next, processing proceeds to S3034, where movements of arms for canceling the spin force are determined 
This processing is the same as the processing of S032 in Fig. 1 2 in the first embodiment. 

[0478] The gait instantaneous values at current time t, generated by the processing up to S3034 described above, 
are hereinafter referred to as simplified model's gait instantaneous values. In this embodiment, the simplified model's 
gait instantaneous values are determined by the use of the simplified model (dynamic model in Fig! 10) to cause the 
floor reaction force's moment generated about the desired ZMP by the resultant force of the inertia! force and gravity 
generated in the robot 1 by a movement thereof, to be zero (to satisfy the dynamic equilibrium conditions with respect 
to the desired ZMP). ■ K 

[0479] In this case, among the simplified model's instantaneous values, the instantaneous values of the body hori- 
zontal position and body posture angle, as well as the instantaneous value of the body vertical position are provisional 
instantaneous values and will be corrected by full-model correction described later. Moreover, among the simplified 
model's instantaneous values in this embodiment, the instantaneous value of the desired floor reaction force's moment 
about the desired ZMP is normally zero. However, a desired floor reaction force's moment for compliance control will 
be generated as a desired value of the floor reaction force's moment to be generated about the desired ZMP by the 
full-model correction described later. 

[0480] Next, processing proceed to S3036, where instantaneous values (values at current time t) of the floor reaction 
force's horizontal component allowable limit for gait correction and ZMP allowable range are obtained based on the 
parameters (set in S3030) defining the floor reaction force's horizontal component allowable limit for gait correction 
and ZMP allowable range. 

[0481] Next, processing proceeds to S3038, where the corrected gait is generated (gait is corrected) by the use of 
the full model. Thus, final instantaneous values of the desired gait are determined. In other words, as described with 
reference to foregoing Fig. 47, the corrected desired body position/posture andthe desired floor reaction force'smoment 
for compiiance control serving as the desired floor reaction force's moment about the desired ZMP, are calculated 
(determined), for example. 

[0482] Next, processing proceed to S3040, where time t is increased by At. Thereafter, processing returns to S301 4 
and the processing from S3014 to S3040 is repeated. 

[0483] The processing of S3038 described above is a characteristic part of this embodiment and is detailed herein- 
below. A method of gait correction by the device according to this embodiment is a full-model feed-forward correction 1 
type. In addition, the inverse dynamic full model (inverse full model) is used in this method. Further, in this method, the 
inputs of the simplified model's gait are not corrected and a perturbation model is used. 
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[0484] Fig. 49 is afunctional block diagram explaining the operation of the gait generating device 100 of this em- 
bodiment, more specifically, the gait correction method of S3038 of the flowchart in Fig. 48. A simplified model 200 in 
Fig. 49 represents not only a dynamic model but also the processing from S301O to S3034 described earlier, that is } 
the calculation (determination) processing of the simplified model's gait instantaneous values. Therefore, in Fig. 49, 
5 the processing after the simplified model 200 corresponds to the processing of S3038. 

[0485] Note that, the processing for determining the instantaneous values of the floor reaction force's horizontal 
component allowable limit for gait generation and ZMP allowable range is denoted by Reference Symbol S3036 of the 
flowchart in Fig.48. 

[0486] the actual processing is executed by using a single computer. Thus, after the block diagram is broken up, 
10 the actual processing is sequentially executed from the upstream side to the downstream side (gait output side) of the 
block diagram. However, a value (state quantity) calculated in the last control cycle (time t-At with respect to current 
time t) is used as a feedback amount which returns to the upstream side, Note that the value calculated by the last 
control cycle (time t-At) is abbreviated as a last value. 

[0487] Whenever the processing of S3038 is executed, calculation for one control cycle in the block diagram is 
15 executed. 

[0488] In S3038, first of all, inputted to the foregoing inverse dynamic full model (inverse full model) 201 are instan- 
taneous values of valuables expressing movements (movement variables) of the desired body posture angle of the 
simplified model's gait obtained as above (hereinafter, referred to as a simplified model's body posture angle), desired 
body horizontal position of the same (hereinafter, referred to as a simplified model's body horizontal position), desired 

20 center of gravity of the same, desired foot position/posture of the same, desired arm postures of the same, and the 
like, as well as the instantaneous value of the desired ZMP. Calculation processing of the inverse full model 201 cal- 
culates a floor reaction force's horizontal component and a floor reaction force's moment about the desired ZMP which 
balance with the movements expressed by the movement variables inputted (in other words, a floor reaction force's 
horizontal component and a floor reaction force's moment about the desired ZMP which are generated from the full 

25 model by the movements). Note that the floor reaction force's moment about the desired ZMP in the simplified model's 
gait is zero. Thus, the floor reaction force's moment about the desired ZMP calculated by the inverse full model 201 
has a meaning of an error of the simplified model's gait. Note that the floor reaction force's horizontal component and 
floor reaction force's moment obtained by the inverse full model 201 are referred to as "full-model's floor reaction force's 
horizontal component" and "full-model's floor reaction force's moment", respectively, Hereinafter, the full-model's floor 

30 reaction force's horizontal component and the full-model's floor reaction force's moment are often abbreviated as Ffull 
and Mfull, respectively. 

[0489] Further, the above-mentioned inverse full model 201 calculates a body vertical position satisfying the desired 
center of gravity' Furthermore, though not illustrated, the inverse full model 201 calculates the center of gravity hori- 
zontal position. 

35 [0490] Supplementally, the desired total center of gravity vertical position is inputted to the full model. In addition, 
the desired floor reaction force's vertical component is obtained from the second-order differential of the desired total 
center of gravity vertical position. Thus, it is not particularly required to input the desired floor reaction force's vertical 
component to the full model. Although it will cause redundancy, the desired floor reaction force's vertical component 
may be inputted to the full model to reduce calculation. 

40 [0491] Here, a perturbation model used for the gait correction is described. 

[0492] The perturbation model is configured by a perturbation model for correcting body horizontal position 202 and 
a perturbation model for correcting body posture angle 203. Note that the perturbation model may be one model like 
the one in Fig. 1 0 instead of being broken up into two models. 

[0493] The perturbation model for correcting body horizontal position 202 expresses a relation between a perturbation 
45 of the floor reaction force and a perturbation of the body horizontal position in the foregoing body translation mode. 
[0494] The perturbation model for correcting body horizontal position 202 receives an input of a correction amount 
of the desired floor reaction force's moment and calculates a correction amount of the desired body horizontal position 
which dynamically balances with the input. This input (correction amount of the desired floor reaction force's moment) 
is called a perturbation model's moment for correcting body horizontal position Mp. The output of the perturbation 
so model for correcting body horizontal position 202 (correction amount of the desired body horizontal position) is called 
a perturbation model's body horizontal position for correction Xc. Further, the floor reaction force's horizontal component 
generated by the perturbation model for correcting body horizontal position 202 is called a perturbation model's floor 
reaction force's horizontal component for correcting body horizontal position Fp. 

[0495] As shown in Fig. 50, the perturbation model for correcting body horizontal position 202 is expressed by an 
55 inverted pendulum configured by a fulcrum, a inverted pendulum material particle (body material particle), and an 
elastic support bar connecting the fulcrum and the inverted pendulum material particle. The position of the fulcrum is 
set so that the horizontal position of the fulcrum coincides with the horizontal position of the origin of the current time 
gait's supporting leg coordinate system described earlier, and the vertical position of the fulcrum coincides with the 
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vertical position of the desired ZMP. The mass mb of the inverse pendulum material particle is equal to the mass of 
the body materia! particle of the foregoing simplified mode! shown in Fig. 10 (model having three material particles + 
flywheel). The vertical position Zc of the inverse pendulum is equal to the vertical position Zb of the body material 
particle of the simplified model shown in Fig. 1 0 which corresponds to the simplified gait. 

5 . [0496] The perturbation model for correcting body horizontal position 202 expresses a relation between a perturbation 
of floor reaction force's moment AMy and a perturbation of body material particle's horizontal position AXb in Equations 
01 , 02 and 03, dynamic equations of the foregoing simplified model (model with three material particles). 
[0497] Hence, functions other than My, Xb and Zb are regarded as constants, and the relation between the pertur- 
bation of floor reaction force's moment AMy and the perturbation of body material particle's horizontal position AXb is 

10 obtained from Equation 03. Thus, the following equation is obtained. 

AMy = -mb*AXb*(g+d2Zb/dt2) + mb*(Zb-Zzmp)*d2AXb/dt2 Equation a12 

15 [0498] Similarly, functions other than Fx and Xb are regarded as constants, and the relation between the perturbation 
of floor reaction force's horizontal component A Fx and the perturbation of body material particle's horizontal position 
AXb is obtained from Equation a9. Thus, the following equation is obtained. 

20 AFx = mb*d2AXb/dt2 Equation a13 

[0499] The foregoing body translation mode floor reaction force ratio h, which is a ratio between AMp and AFp gen- 
erated by the body horizontal acceleration, is a ratio between a term generated by the body horizontal acceleration 
(that is, the second term) on the right side of Equation ai 2, and Equation.a13. Thus, the following equation is obtained. 

h-(Zb-Zzmp) Equation ai 4 

[0500] In other words, the body translation mode floor reaction force ratio h is equivalent to the height of the body 
30 material particle (inverse pendulum material particle) from the fulcrum of the simplified model. 
[0501] Thus, the following equation is obtained from Equations a12 and a14. 
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AMy - -mb*AXb*(g+d2Zb/dt2) + mb*h*d2AXb/dt2 . Equation a1 5 

[0502] Meanwhile, a floor reaction force's vertical component which balances with the translational force's vertical 
component of the resultant force of the gravity and inertial force acting on the body material particle (inverse pendulum 
material particle), is called a body's floor reaction force's vertical component Fbz. In other words, the body's floor 
reaction force's vertical component Fbz is defined by the following equation. • 

Fbz = mb*(g+d2Zb/dt2) Equation a1 6 

[0503] Based on Equation a8, the body's floor reaction force's vertical component Fbz is expressed by the following 
45 equation. 

Fbz = Fz - msup*(g+d2Zsup/dt2) - mswg*(g+d2Zswg/dt2) Equation a1 7 
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[0504] In other words, the body's floor reaction force's vertical component is equal to the sum of the floor reaction 
force's vertical component Fz and the translational force's vertical component of the resultant force of the gravity and 
inertial force acting on the material particles of both legs of the foregoing simplified model shown in Fig. 1 0 (model with 
three material particles and flywheel). 

[0505] By substituting Equation a15 in Equation a16, the following equation is obtained. 

AMy - -Fbz*AXb + mb*h*d2AXb/dt2 Equation a1 8 
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[0506] The following equation is obtained by bringing AMy in Equation a1 8 into correspondence with the perturbation 
model's moment for correcting body horizontal position Mp, and bringing AXb into correspondence with the perturbation 
model's body horizontal position for correction Xc (by substituting the perturbation model's moment'for correcting body 
horizontal position Mp for AMy in Equation a1 8, and substituting the perturbation model's body horizontal position for 
s correction Xc for AXb). 

Mp = -Fbz*Xc + mb*h*d2Xc/dt2 Equation a1 9 

10 [0507] Thus, the perturbation model for correcting body horizontal position 202 is expressed by Equation a19, by 
using the body translation mode floor reaction force ratio h obtained in Equation a14 and body's floor reaction force's 
vertical component Fbz obtained in Equation a17. 

[0508] Further, the following equation is obtained by bringing A Fx of Equation a13 into correspondence with the 
perturbation model's floor reaction force's horizontal component for correcting body horizontal position Fp. 
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Fp = mb*d2Xc/dt2 Equation a20 



[0509] In other words, the perturbation model for correcting body horizontal position 202 is described by Equations 

20 a14, a17, a19, and a20. 

[0510] Supplementally, it is herein considered that the perturbation of the body material particle's position and the 
perturbation of body position (position of body's representative point) coincide with each other. Strictly speaking, how- 
ever, they do not always coincide with each other. Therefore, a model expressing a geometric relation between the 
body material particle's horizontal position and body position is further required in order to obtain the relation among 

25 Mp, Fp and Xc. 

[0511] Meanwhile, the perturbation model for correcting body posture angle 203 expresses a relation between a 
perturbation of floor reaction force and a perturbation of body posture angle in the foregoing body rotation mode. 
[0512] The perturbation model for correcting body posture angle 203 receives an input of an correction amount of 
. the floor reaction force's moment, and calculates a correction amount of the desired body posture angle which dynam- 
ic ically balances with the input. This input (correction amount of the floor reaction force's moment) is called a perturbation 
model's moment for correcting body posture angle Mr. Further, the output of the perturbation model for correcting body 
posture angle 203 (correction amount of the desired body posture angle) is called a perturbation model's body posture 
angle for correction 8c. In addition, a floor reaction force's horizontal component generated by the perturbation model 
for correcting body posture angle is called a floor reaction force's horizontal component of perturbation model for 
35 correcting body horizontal position Fr. As mentioned earlier, Fr is zero. Thus, the following equation always holds true. 

• Fr=0 Equation a21 

40 [0513] The perturbation model for correcting body posture angle 203 is expressed by afiywheel FH as shown in Fig. 
51 . Inertia of the flywheel is equal to that of the flywheel FH of the foregoing simplified model shown in Fig, 1 0 (model 
with three material particles + flywheel). A rotation angle of the flywheel of the perturbation model for correcting body 
posture angle 203 corresponds to the perturbation model's body posture angle for correction Be, and the floor reaction 
force's moment generated by the flywheel corresponds to the perturbation model's moment for correcting body posture 

45 angle Mr, 

[0514] The perturbation model for correcting body posture angle 203 expresses a relation between a perturbation 
of the floor reaction force's moment AMy and a perturbation of the body posture angle AGby in foregoing Equation 03, 
a dynamic equation of the foregoing simplified model (model with three material particles + flywheel). 
[0515] Thus, functions other than My and Gby are regarded as constants, and the relation between the perturbation 
so of the floor reaction force's moment AMy and the perturbation of the body posture angle AGby is obtained from Equation 
03. Thus, the following equation is obtained. 

AMy = J*d2A0by/dt2 Equation a22 



[0516] The following equation is obtained by bringing AMy of Equation a22 into correspondence with the perturbation 
model's moment for correcting body posture angle Mr, and bringing AG by into correspondence with the perturbation 
model's body posture angle for correction Gc. 
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Mr= J*d2A6c/dt2 • Equation a23 

[0517] In other words, the perturbation model for correcting body posture angle 203 is expressed by Equation a23 
Further, the perturbation model's floor reaction force's horizontal component for correcting body horizontal position Fr 
is expressed by Equation a21 as described earlier (Fr = 0). 

[0518] As described later, in S3038, a corrected gait (to be more specific, desired instantaneous values obtained by 
partially correcting the instantaneous values of the simplified model's gait) is ultimately generated (outputted) The 
desired body posture angle of the corrected gait (hereinafter, referred to as corrected desired body posture angle) is 
obtained by adding the aforementioned perturbation model's body posture angle for correction 0c (value obtained rn 
the control cycle at current time t) to the instantaneous value of the simplified model's body posture angle obtained 
earlier (instantaneous value of the desired body posture angle at current time t of the current time gait obtained in 
S3032) at a calculator 204. The desired body horizontal position of the corrected gait (hereinafter, referred to as cor- 
rected desired body horizontal position) is obtained by adding the perturbation model's body horizontal position for 
correction Xc (value obtained in the control cycle at current time t) to the instantaneous value of simplified model's 
body horizontal position obtained earlier (instantaneous value of the desired body horizontal position at current time t 
of the current time gait, obtained in S032) at a calculator 205. 

[0519] The desired floor reaction force of the corrected gait is also corrected.' Specifically, the floor reaction force's 
moment's horizontal component about the desired ZMP is no longer zero, and the desired floor reaction force's moment 
for compliance control is outputted as the desired value. Further, the desired floor reaction force's horizontal component 
is corrected into the corrected desired floor reaction force's horizontal component and outputted 
[0520] As described earlier, a movement of the corrected gait is a movement obtained by adding (combining) per- 
turbation model's movements (specifically, movements of the perturbation model for correcting body position/posture 
and the perturbation model for correcting body posture angle) to a movement of the simplified model's gait 
[0521] Generally, a floor reaction force, generated from a movement obtained by adding a perturbation movement 
to a reference movement, approximates to the sum of a floor reaction force generated by the reference movement 
(floor reaction force balancing with the gravity and inertial force generated by the movement) and a perturbation of a 
floor reaction force generated by the perturbation movement. 

[0522] Thus, a floor reaction force generated by a movement of the corrected gait (precisely a value of floor reaction 
force generated by the movement of the corrected gait, calculated by the use of the inverse full model 201 ) is obtained 
by adding the input moment of the perturbation model for correcting body position/posture 202 (foregoing perturbation 
model's moment for correcting body horizontal position Mp) and the input moment of the perturbation model for cor- 
recting body posture angle 203 (foregoing perturbation model's moment for correcting body posture angle Mr) to the 
floor reaction force of the Inverse full model 201 (the value of floor reaction force generated by a movement of the 
simplified model's gait, calculated by the use of the inverse full model 201), 

[0523] To satisfy the dynamic equilibrium conditions by the corrected gait with good accuracy is equal to that the 
floor reaction force generated by the movement of the corrected gait (precisely, the floor reaction force generated on 
the inverse full model 201 by the movement of the corrected gait) almost coincides with the corrected desired floor 
reaction force. Thus, in order to satisfy the conditions, the following two equations should be satisfied. 

Full-model's floor reaction force's moment Mfull 
-i- perturbation model's moment for correcting body horizontal 

position Mp 

+ perturbation model's moment for correcting body posture angle 

Mr 

= corrected desired floor reaction force's moment Equation a5 

Full-model's floor reaction force's horizontal component Ffull 
+ perturbation model's floor reaction force's horizontal component 
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for correcting body horizontal position Fp 
+ perturbation model's floor reaction force's horizontal component 

for correcting body posture angle Fr 

* 

= corrected desired floor reaction force's horizontal component Equation a6 

[0524] Further, the true ZMP of the corrected gait is changed to a point shifted from the desired ZMP (ideal desired 
ZM P) of the simplified model's gait by a value obtained by dividing the corrected desired floor reaction force's moment 
by thedesired floor reaction force's vertical component. 

True ZMP of corrected gait 
= desired ZMP 

+ corrected desired floor reaction force's moment/desired floor 

reaction force's vertical component Equation a7 

[0525] Note that, when calculating an X-direction (front-and-back direction) component of the true ZMP of the cor- 
rected gait, a component about Y axis (right-and-left direction axis) of the corrected desired floor reaction force's mo- 
ment is used. Further, when calculating a Y-direction component of the true ZMP of the corrected gait, a component 
about the X axis (front-and-back axis) of the corrected desired floor reaction force's moment is used. However, when 
calculating the Y-direction component of the true ZM P of the corrected gait, V on the right side of Equation a7 should 
be 

[0526] The true ZMP of the corrected gait obtained by Equation a7 should be within the ZMP allowable range. This 
is called ZMP constraint. 

[0527] Moreover, the corrected desired floor reaction force's horizontal component should be within the floor reaction 
force's horizontal component allowable limit for gait correction. This is called a floor reaction force's horizontal compo- 
nent constraint. 

[0528] As described above, the corrected gait should satisfy Equations a5, a6, the ZMP constraint (condition on a 
range where the true ZMP of the corrected gait obtained by Equation a7 exists) and the floor reaction force's horizontal 
component constraint. 

[0529] However, to simply satisfy these equations and conditions results in divergence of the foregoing perturbation 
model's body position for correction and the perturbation model's body posture angle for correction. 
[0530] Therefore, based on state quantities of the foregoing perturbation model for correcting body horizontal position 
202 and perturbation model for correcting body posture angle 203 (to be more specific, body horizontal position/velocity 
of the perturbation model for correction, body posture angle and its angular velocity of perturbation model for correction, 
and the like), stabilization control of the perturbation models for correction 202 and 203 is performed to converge 
(stabilize) these state quantities to predetermined states.. 

[0531] First of all, the stabilization control of the perturbation model for correcting body horizontal position 202 is 
detailed. 

[0532] In Patent Application No. 2001-133621 earlier proposed by the present applicant, there is the control law in 
which the perturbation model of inverse-pendulum type is used to cause the center of gravity horizontal position XGf 
calculated by using the full model based on instantaneous posture of the corrected gait to converge to the center of 
gravity horizontal position XGs calculated by using the simplified model based on instantaneous posture of the simplified 
model's gait. A feedback amount (feedback manipulated amount) determined by the control law is additionally inputted 
to the perturbation model for correcting body horizontal position. 

[0533] Specifically, the control law of Equation a9 is given so that the center of gravity horizontal position XGf con- 
verges to a desired settling position given in Equation a8. Here, mtotal is the foregoing gloss weight of the robot, mb 
is the foregoing mass of body material particle (mass of inverse pendulum), XGf is the center of gravity horizontal 
position calculated by the use of the full model based on the instantaneous position of the simplified model's gait, that 
is, the center of gravity horizontal position calculated by the foregoing inverse full model. Further, Kp and Kv are gains 
of feedback control. 
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Desired settling position = -mtotal/mb*(XGf~XGs) Equation a8 

ZMP-converted value of feedback amount for controlling 
perturbation model for correcting body horizontal position 
= Kp*(perturbation model's body horizontal position for correction 

- desired settling position) 
+ Kv*perturbation model's body horizontal velocity for correction 
15 + perturbation model's body horizontal position for correction Equation a9 

[0534] Supplementary, when calculation is actually executed on a computer, values of the variables on the right 
side of the above equations are last values thereof. The same can be said of control laws described below 
[0535] The perturbation model for correcting body horizontal position used in the full-model correction method pro- 
posed at this time by the present applicant has strong nonlinearity. However, this perturbation model is similar to the 
perturbation model forcorrecting body horizontal position used in Patent Application No. 2001 -1 33621 earlier proposed 
before aPpl ' Cant ° f thS present a PP ,icati °n concerned, in that the model is the inverse-pendulum type as described 

[0536] Thus, in the full-model correction method proposed at this time, the desired settling position is determined 
similarly to above, and only a control law for convergence to the desired stabilized position is changed 
[0537] A control law for causing the perturbation model for correcting body horizontal position 202 to converqe (to 
be stabilized) to the desired settling position is called a perturbation model control law for correcting body horizontal 
position 206. A feedback amount (manipulated amount) determined by this control law is called a required value of 
perturbation model's stabilization moment for correcting body horizontal position Mpfdmd. The term "required value- 
is added because a value determined by the above control law is limited and corrected so that the true ZMP is within 
the foregoing ZM P allowable range and the floor reaction force's horizontal component is within the floor reaction force's 
horizontal component allowable limit as described later. This limited and corrected moment is called a perturbation 
model's stabilization moment for correcting body horizontal position Mpf . 

[0538] For the perturbation model control law for correcting body horizontal position 206, the following equation can 
35 be used in stead of Equation a9. 

Required value of perturbation model's stabilization moment for 
40 correcting body horizontal position Mpfdmd 

= Kpp*(perturbation model's body horizontal position for 
correction Xc - desired settling position) 

45 

+ Kpv * perturbation model's body horizontal velocity for 

correction dXc/dt 

so ' Perturbation model's body horizontal position for correction Xc 

* body's floor reaction force's vertical component Fbz Equation a1 0 
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where Kpp and Kpv are gains of feedback control. 

[0539] As stated in the description regarding the perturbation model forcorrecting body horizontal position 202 the 
body's floor reaction force's vertical component Fbz is acting on the body material particle (inverse penduium material 
particle) in the vertical direction. Therefore, as the body material particle's position shifts from the origin (position of 
the fulcrum), a moment acts on the body material particle, causing the body material particle's position to shift even 
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further The third term on the right side of Equation a1 0 is a moment for canceling this moment. 
[0540] When obtaining a component about the X axis (front-and-back axis) of the required value of perturbation 
model's stabilization moment for correcting body horizontal position Mpfdmd, Y-axis direction (right-and-left direction) 
components of the perturbation model's body horizontal position/velocity for correction and desired settling position 

are used. „ 
[0541] When obtaining a component about Lhe Y axis (right-and-left axis) of the required value of perturbation model s 

stabilization moment for correcting body horizontal position Mpfdmd, X-axis direction (front-and-back direction) com- 
ponents of the perturbation model's body horizontal position/velocity for correction and desired settling position are 
used, and "-" in the third term on the right side is changed to V. 

[0542] Note that the desired settling position may be zero (horizontal position of the inverse pendulum fulcrum). 
Further the perturbation model control law for correcting body horizontal position 206 may be any one of various 
methods described in Patent Application No. 2001-133621 earlier proposed by the present applicant. Alternatively, 
apart from the above, the perturbation model control law for correcting body h orizontal position 206 may be determined 
based on at least any one of state quantites of the perturbation model for correcting body horizontal position 202 (more 
specifically, body horizontal position/velocity of perturbation model for correction , or the like) so that the state quantity 
converges (is stabilized) to the predetermined state. 

[0543] Next, stabilization control of the perturbation model for correcting body posture angle 203 is detailed. 
[0544] A feedback amount (manipulated amount) is determined by a feedback control law, such as PI control, in 
accordance with the state of the perturbation model for correcting body posture angle 203 so that the corrected desired 
body posture angle, that is, the posture angle obtained by adding perturbation model's body posture angle for correction 
to the desired body posture angle by the simplified model, is settled to or follow the reference body posture angle 
outputted by the desired instantaneous value generator 100b (obtained in S1 004 in Fig. 40) or the desired body posture 
angle by the simplified model (obtained in S1014 in Fig. 40). The feedback amount is additionally inputted to the 
perturbation model for correcting body posture angle 203. 

[0545] The above control law is called a perturbation model control law for correcting body posture angle 207. The 
feedback amount (manipulated amount) is called a required value of perturbation model's stabilization moment for 
correcting body posture angle Mrfdmd. The term "required value" is added for a reason similar to that for the required 
value of perturbation model's stabilization moment for correcting body horizontal position Mpfdmd. A limited and cor- 
rected moment Is called a perturbation model's stabilization moment for correcting body posture angle Mrf. 
[0546] The perturbation model control law for correcting body posture angle 207, which determines the required 
value of perturbation model's stabilization moment for correcting body posture angle Mrfdmd, can be specifically ex- 
pressed as the following equation. 

Required value of perturbation model's stabilization moment for 
correcting body posture angle Mrfdmd 
= Krp * (perturbation model's body posture angle for correction Be 
. (reference body posture angle - required body posture angle by 

simplified model)) 
+ Krv * perturbation model's body posture angular velocity for 

correction d0c/dt Equation a1 1 

where Krp and Krv are gains of feedback control. 

[0547] Note that, in Equation all, zero may be used instead of (reference body posture angle - required body posture 

angle by simplified model). _ , . , 

• [0548] Again, the processing of S3038 is described using thefunctional block diagram in Fig. 49. As described above, 
the required value of perturbation model's stabilization moment for correcting body horizontal position Mpfdmd is ob- 
tained by the aforementioned perturbation model control law for correcting body horizontal position 206 (Equation a1 0). 
In addition, the required value of perturbation model's stabilization moment for correcting body posture angle Mrfdmd 
is obtained by the aforementioned perturbation model control law for correcting body posture angle 207 (Equation a11 ). 
[05491 Next, obtained by a F0 calculator 208 is an estimated (calculated) value F0 of floor reaction force of the 
perturbation modelfor correcting body position underthe assumption thatthe perturbation model's stabilization moment 
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for correcting body horizontal position Mpf is zero. As described later, the perturbation model's stabilization moment 
for correcting body horizontal position Mpf is added to the full-model's floor reaction force's moment Mfull and the 
resultant moment is inputted to the perturbation model for correcting body horizontal position 202 Accordinqly F0 is 
a floor reaction force generated by the perturbation model for correcting body horizontal position 202 when only the 
^model's floor reaction force's moment, whose sign is changed, is inputted to the perturbation model for correcting 
body horizontal position 202. y 
[0550] Specifically, FO is obtained by the following equation. 

w F0 = mb*d2Xc/dt2-1/h*Mpf Equation a1 2 

[0551] The first term on the right side represents a floor reaction force's horizontal component of the perturbation 
model for correcting body horizontal position 202 at the last time (time t-At). 

[0552] The second term on the right side represents a floor reaction force's horizontal component directly generated 
to the perturbation model for correcting body horizontal position 202 by the last perturbation model's stabilization mo- 
ment'for correcting body horizontal position Mpf (that is, a floor reaction force's horizontal component of a feedthrough 

[0553] In other words, a value obtained by dividing the last perturbation model's stabilization moment for correcting 
body horizontal position Mpf by the body translation mode floor reaction force ratio h is subtracted from a value obtained 
by multiplying the last body material particle's horizontal acceleration of the perturbation model for correctinq bodv 
horizontal position 202 by the mass of body material particle mb. Thus, the estimated value of floor reaction force FO 
of the perturbation model for correcting body horizontal position, under assumption that Mpf is zero is obtained 
[0554] Next, a floor reaction force's moment Min generated about the desired ZMP is obtained by a Min calculator 
209 under the following assumptions: the perturbation model's stabilization moment for correcting body horizontal 
position Mpf is caused to coincide with the required value of perturbation model's stabilization moment for correctinq 
body horizontal position Mpfdmd; the perturbation model's stabilization moment for correcting body posture angle Mrf 
is caused to coincide with the required value of perturbation model's stabilization moment for correctinq body posture 
angle Mrfdmd; and thedesiredfloor reaction force's momentforcompliancecontrol, serving as the desired floorreaction 
force s moment about the desired ZMP, is caused to coincide with the total sum of the compensated total floor reaction 
force s moment Mdmd, Mpf, and Mrf. Atthis time, the foregoing constraints (floor reaction force's horizontal component 
constraint and ZMP constraint) are ignored. This floor reaction force's moment is called an unlimited corrected desired 
floor reaction force's moment Min. The unlimited corrected desired floor reaction force's moment Min is obtained bv 
the following equation. y 

Min = Mpfdmd + Mrfdmd + Mdmd Equation a1 3 

[0555] In other words, the unlimited corrected desired floor reaction force's moment Min is obtained by adding the 
required value of perturbation model's stabilization moment for correcting body horizontal position Mpfdmd, the required 
value of perturbation model's stabilization moment for correcting body posture angle Mrfdmd, and the compensated 
total floor reaction force's moment Mdmd. 

[0556] Next, a floor reaction force's horizontal component Fin is obtained by a Fin calculator 21 0 The floor reaction 
forces horizontal component Fin is generated under the following assumption: the perturbation model's stabilization 
moment for correcting body horizontal position Mpf is caused to coincide with the required value of perturbation model's 
stabilization moment for correcting body horizon tal position Mpfdmd; the perturbation model's stabilization moment for 
correcting body posture angle Mrf is caused to coincide with the required value of perturbation model's stabilization 
moment forcorrecting body posture angle Mrfdmd; and the desired floor reaction force's moment forcompliance control 
is caused to coincide with the total sum of the compensated total floor reaction force's moment Mdmd, Mpf and Mrf 
Atthis time, the foregoing constraints (floor reaction force's horizontal component constraint and ZMP constraint) are 
ignored. This floor reaction force's horizontal component is called an unlimited corrected desired floor reaction force's 
horizontal component Fin. 

[0557] The corrected desired floor reaction force's horizontal component is obtained by foregoing Equation a6 As 
described earlier, however, the floor reaction force's horizontal component is not generated in the perturbation model 
for correcting body posture angle 203 by behavior of the perturbation model for correcting body posture angle 203 In 
other words Fr is zero, Hence, a floor reaction force's horizontal component, which increases as the perturbation 
model Is stabilization moment for correcting body horizontal position Mpf is changed from zero to the required value of 
perturbation model's stabilization moment for correcting body horizontal position Mpfdmd. is added to the corrected 
desired floor reaction force's horizontal component under assumption that the perturbation model's stabilization mo- 
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ment for correcting body horizontal position Mpf is zero. The resulting value is the unlimited corrected desired floor 
reaction force's horizontal component Fin. 

[0558] Incidentally, the floor reaction force's horizontal component, which increases as the perturbation model's sta- 
bilization moment for correcting body horizontal position Mpf is changed from zero to the required value of perturbation 
model's stabilization moment for correcting body horizontal position Mpfdmd, has a value obtained by dividing the 
required value of perturbaLion model's stabilization moment forcorrecling body horizontal position Mpfdmd by the body 
translation mode floor reaction force ratio h. 

[0559] Therefore, as shown in Equation a15, the unlimited corrected desired floor reaction force's horizontal com- 
ponent Fin is obtained as follows. The full-model's floor reaction force's horizontal component Ffuil is added to the 
value obtained by dividing the required value of perturbation model's stabilization momentfor correcting body horizontal 
position Mpfdmd by the body translation mode floor reaction force ratio h. Further, the calculated value of the floor 
reaction force F0 of the perturbation model for correcting body position, under assumption that the perturbation model's 
stabilization moment for correcting body horizontal position Mpf is zero, is also added to the above value. 

Fin = 1 /h* Mpfdmd +Ffull + F0' . Equation a1 5 

[0560] Next, limiting means (limitation processing unit) 211 detailed later determines a limited corrected desired floor 
reaction force's moment Mltd (about the desired ZMP) and a limited corrected desired floor reaction force's horizontal 
component Fltd from the unlimited corrected desired floor reaction force's moment Min and the unlimited corrected 
desired floor reaction force's horizontal component Fin, respectively. The moment Mltd and the component Fltd are 
values obtained by imposing limitations to the moment Min and the component Fin. In this embodiment, the desired 
floor reaction force's moment for compliance control coincides with the limited corrected desired floor reaction force's 
moment Mltd, and the floor reaction force's horizontal component of the corrected gait coincides with the limited cor- 
rected desired floor reaction force's horizontal component Fltd. 

[0561] The limited corrected desired floor reaction force's moment Mltd and limited corrected desired floor reaction 
force's horizontal component Fltd are determined so that the true ZMP of the corrected gait (including the desired floor 
reaction force's moment for compliance control) is within the foregoing ZMP allowable range, and the floor reaction 
force's horizontal component of the corrected gait is within the floor reaction force's horizontal component allowable 
limit. In other words, Mltd and Fltd are determined to satisfy the ZMP constraint and floor reaction force's horizontal 
component constraint. 

[0562] Further, the perturbation model's stabilization moment for correcting body horizontal position Mp is determined 
to be the same as or the closest value to the required value of perturbation model's stabilization momentfor correcting 
body horizontal position Mpfdmd as much as possible. Similarly, the perturbation model's stabilization momentfor 
correcting body posture angle Mr is determined to be the same as or the closest value to the required value of pertur- 
bation model's stabilization moment for correcting body posture angle Mrfdmd as much as possible. Accordingly, the 
foregoing perturbation model's body position for correction Xc and perturbation model's body posture angle for correc- 
tion Gc are stabilized and prevented from diverging. 

[0563] Next, the perturbation model's stabilization moment for correcting body horizontal position Mpf and the per- 
turbation model's stabilization moment for correcting body posture angle Mrf are obtained by Mpf calculator 212 and 
Mrf calculator 21 3, respectively, by the following equations. 

Mpf = (Fltd - Fful! - F0)*h Equation a20 

Mrf = Mltd - Mpf - Mdmd Equation a21 

[0564] In other words, at the Mpf calculator 212, the full-model's floor reaction force's horizontal component Ffull is 
subtracted from the limited corrected desired floor reaction force's horizontal component Fltd, and the calculated value 
of the floor reaction force F0 of perturbation model for correcting body position 202 Is further subtracted from Fltd, 
assuming that Mp is zero. The resulting value is then multiplied by the body translation mode floor reaction force ratio 
h. Thus, the perturbation model's stabilization moment for correcting body horizontal position Mpf is obtained. Further, 
at the Mrf calculator 21 3, the perturbation model's stabilization momentfor correcting body posture angle Mrf is obtained 
by subtracting the above-mentioned perturbation model's stabilization moment for correcting body horizontal position 
Mpf and compensated total floor reaction force's moment Mdmd from the limited corrected desired floor reaction force's 
moment Mltd about the desired ZMP. 

[0565] Next, the perturbation model's floor reaction force's moment for correcting body horizontal position Mp and 
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perturbation model's floor reaction force's moment for correcting body posture angle Mr are obtained by the followinq 
equations. y 

Mp= Mpf -Mfull Equation a22 

Mr= Mrf Equation a23 

[0566] Specifically, at an Mp calculator 214, the perturbation model's floor reaction force's moment for correctinq 
body horizontal position Mp is obtained by subtracting the full-model's floor reaction force's moment Mfull from the 
perturbation model's stabilization moment for correcting body horizontal position Mpf. Further, the perturbation model's 
floor reaction force's moment for correcting body posture angle Mr has the same value as the perturbation model's 
stabilization moment for correcting body posture angle Mrf. 

[0567] Next, the perturbation model's floor reaction force's moment for correcting body horizontal position Mp is 
inputted to the perturbation model for correcting body position 202, and the perturbation model's body position for 
correction Xc, which balances with the inputted floor reaction force's moment, is calculated 

[0568] Moreover, the perturbation model's floor reaction force's moment for correcting body posture angle Mr is 
inputted to the perturbation model for correcting body posture angle 203, and the perturbation model's body posture 
angle for correction 9c, which balances with the inputted floor reaction force's moment, is calculated 
[0569] Next, corrected desired body horizontal position and corrected desired body posture angle are determined 
at calculators 205 and 204, in accordance with the following Equations a24 and a25, respectively. These are outputted 
as final desired instantaneous values of the body horizontal position/posture, respectively. 



Corrected desired body horizontal position 
= simplified model's body horizontal position 
30 + perturbation model's body position for correction Xc Equation a24 

Corrected desired body posture angle 
35 = simplified model's body posture angle 

+ perturbation model's body posture angle for correction Gc Equation a25 



[0570] In other words, the corrected desired body horizontal position is obtained by adding the perturbation model's 
body position for correction Xc to the simplified model's body horizontal position, and outputted as the final desired 
body horizontal position. Further, the corrected desired body posture angle is obtained by adding the perturbation 
model s body posture angle for correction 6c to the simplified model's body posture angle, and outputted as the final 
desired body posture angle. 

[0571] In addition, the limited corrected desired floor reaction force's moment Mltd is outputted as the desired floor 
reaction force's moment for compliance control about the desired ZMR At the same time, the unlimited corrected 
desired floor reaction force's horizontal component Fltd is outputted as the corrected desired floor reaction force's 
horizontal component. 

[0572] In other words, the corrected desired floor reaction force's horizontal component and the corrected desired 
floor reaction force's moment about the desired ZMP are determined as final desired instantaneous values of the floor 
reaction force s horizontal component and floor reaction force's moment (moment about the desired ZMP) respectively 
in accordance with the following Equations a26 and a27, and outputted. . 

Desired floor reaction force's moment for compliance control 

- limited corrected desired floor reaction force's moment Mltd Equation a26 
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Corrected desired floor reaction force's horizontal component 
= limited corrected desired floor reaction force's horizontal 

component Htd Equation a2 7 



[0573] The gait correction of S3038 is performed as described so far. 

[0574] Supplementary, in this embodiment, the correction is the feedforward type and the perturbation dynamic 

10 model is not a precise model. Thus, strictly speaking, even where a gait is corrected to satisfy Equations a5 and a6 
as described earlier, the dynamic equilibrium conditions are not necessarily satisfied but approximately satisfied. 
[0575] Further, in this embodiment, the state quantities of the body movement of the perturbation model for correcting 
body horizontal position 202 and the perturbation model for correcting body posture angle 203, such as the horizontal 
. position of the body material particle (inverse pendulum material particle) of the perturbation model for correcting body 

w horizontal position 202 and the rotation angle of the flywheel of the perturbation model for correcting body posture 
angle 203 are added as state quantites of the simplified model 200 at the end of a gait for one step (current time gait's 
end), for example. In other words, the state quantities of the simplified model 200 at the end of the current time gait 
are corrected by addition of the states of the body movement of the perturbation model for correcting body horizontal 
position 202 and the perturbation model for correcting body posture angle 203. Furthermore, the state quantities of 

20 the respective perturbation models 202 and 203 are initialized. (For example, the horizontal position of the body material 
particle (inverse pendulum material particle) of the perturbation model for correcting body horizontal position 202 and 
the rotation angle of the flywheel of the perturbation model for correcting body- posture angle 203, are reset to zero.) 
Thereafter, the state quantities of the simplified model 200 corrected as above are set as initial values for the next time 
gait, and the next time gait is generated. At the same time, the perturbation model's body horizontal position for cor- 

25 rection Xc and the perturbation model's body posture angle for correction Gc are calculated by the perturbation models 
202 and 203, respectively. Thus, stabilization of behavior of the respective perturbation models 202 and 203 is further 
improved Note that the correction of state quantities of the simplified model 200 as above may also be performed as 
appropriate while a gait is generated. In addition, the correction of state quantities of the simplified model 200 as above 
is performed in the later-described fourth and fifth embodiments in the similar manner. 

30 [0576] Next, the aforesaid limiting means, that is, the processing of the limitation processing unit 211 is detailed. 
[0577] In the limiting means (limitation processing unit 211), the following processing is performed to provide the 
aforementioned functions. 

[0578] First of all, an Instantaneous value of the ZMP allowable range determined by the desired instantaneous value 
generator 100b, that is, an instantaneous value of the ZMP allowable range determined in S3036 in foregoing Fig. 48, 
35 is converted into an instantaneous value of the floor reaction force's moment allowable range about the desired ZMP. 
[0579] Specifically, the floor reaction force's moment allowable range is obtained using the relation of the following 
equation. 



Floor reaction force's moment allowable range 
= (ZMP allowable range - desired ZMP)*floor reaction force's 

vertical component vector Equation a32 

where all variables in Equation a32 are vectors, and the floor reaction force's vertical component vector is a translation 
floor reaction force vector in which components other than the vertical-component are zero. Further, "*" means an outer 
product. 

[0580] It is known that a movement of a gait which only satisfies the dynamic equilibrium conditions (particularly the 
condition that causes the horizontal component of a moment which is acted about the desired ZMP by the resultant 
force of the gravity and inertial force, to be zero) without consideration of the ZMP constraint and the floor reaction 
force's horizontal component constraint, can approximately satisfy the dynamic equilibrium conditions even where the 
movement is generated by combining separated movements on a sagittal plane and oh a lateral plane, each generated 
to satisfy the dynamic equilibrium conditions. Further, by setting the ZM P allowable range and the floor reaction force's 
horizontal component allowable limit for gait correction as above, the ZMP constraint and the floor reaction force's 
horizontal component constraint can also be separated into constraints on the sagittal plane and the lateral plane, 
respectively. Therefore, a movement of a gait under consideration of all of the ZMP constraint, the floor reaction force's 
horizontal component constraint, and dynamic equilibrium conditions can also be generated by combining movements 



72 



10 



15 



25 



EP 1 475 198 A1 

on the sagittal plane and the lateral plane, which are separately generated. 

[0581] Thus, to aid understanding, description is given below regarding the operation of the limiting means only for 
the movement on the sagittal plane. The same description is applied to the movement on the lateral plane 
[0582] Since description is simplified as mentioned above, the following equation can express that the desired floor 
reaction force's moment for compliance control defined by the corrected gait is within the floor reaction force's moment 
allowable range (which means that the true ZMP by a movement of the corrected gait is within the foregoing ZMP 
allowable range). Mmax is the upper limit of the floor reaction force's moment allowable range and Mmin is the lower 
limit of the same. . 

Mmax > desired floor reaction force's moment for compliance 

control > Mmin Equation a33 

[0583] Further, the following eq uation expresses that the floor reaction force's horizontal component of the corrected 
gait is within the floor reaction force's horizontal component allowable limit for gait correction. Fmax is the upper limit 
of the floor reaction force's horizontal component allowable limit and Fmin is the lower limit of the same. 

20 Fmax > floor reaction force's horizontal component for gait 

correction > Fmin Equation a34 

[0584] Furthermore, in this embodiment, the desired floor reaction force's moment for compliance control coincides 
with or almost coincides with the limited corrected desired floor reaction force's moment Mltd, and the floor reaction 
force's horizontal component for gait correction coincides with or almost coincides with the limited corrected desired 
floor reaction force's horizontal component Fltd. 

[0585] Hence, Equations a33 and a34 are approximately converted into the following Equations a35 and a36. 

Mmax > Mltd > Mmin Equation a35 

Fmax > Fltd 2 Fmin Equation a36 

[0586] In the coordinate system shown in Fig. 52, the horizontal axis is a component in the X-axis direction (front- 
and-back axis direction) of the floor reaction force's horizontal component and the vertical axis is a component about 
the Y axis (right-and-left axis) of the floor reaction force's moment. In this coordinate system, assuming that a group 
of the limited corrected desired floor reaction force's horizontal component Fltd and the limited corrected desired floor 
react.on force's moment Mltd (Fltd, Mltd) is a point on the coordinate system, a set of the points (allowable ranqe) 
satisfying Equations a35 and a36 is on the border or inside of the rectangle in Fig. 52. 

[0587] Like the white circle in Fig. 52 (in this drawing, the white circle and the later-described black circle lie on top 
of another), when the unlimited corrected desired floor reaction force's moment Min is within the floor reaction force's 
moment allowable range and the unlimited corrected desired floor reaction force's horizontal component Fin is within 
the floor reaction force's horizontal component allowable limit, in other words, when the point (Fin, Min) is within the 

s moment allowable range and the floor reaction force's hor- 
izontal component allowable limit, Mltd is set as the unlimited corrected desired floor reaction force's moment Min and 
Fltd is set as the unlimited corrected desired floor reaction force's horizontal component Fin, as shown by the black 
circle in the drawing. As a matter of course, Equations a35 and a36 hold true only by setting them as above In other 
words, the desired floor reaction force's moment for compliance control is within the floor reaction force's moment 
allowable range, and the floor reaction force's horizontal componentfor gait correction is within the floor reaction force's 
horizontal component allowable limit. In addition, the unlimited corrected desired floor reaction force's moment Min 
and unlimited corrected desired floor reaction force's horizontal component Fin are outputted as they are as Mltd and 
Fltd, respectively, without being limited (corrected). Thus, theforegoing perturbation model's body positionforcorrection 
and the foregoing perturbation model's body posture angle for correction are appropriately stabilized, thus preventinq 
divergence. r y 

[0588] Like the white circle of Figs. 53 to 55, when the unlimited corrected desired floor reaction force's moment Min 
is not within the floor reaction force's moment allowable range or the unlimited corrected desired floor reaction force's 
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horizontal component Fin is not within the floor reaction force's horizontal component allowable limit, that is : when the 
point (Fin, Min) is not within the rectangular range surrounded by the floor reaction force's moment allowable range 
and the floor reaction force's horizontal component allowable limit, Mltd and Fltd are determined as follows. 
[0589] First of all, before describing a determination method of Mltd and Fltd, a policy in determining Mltd and Fltd 
5 is described. 

[0590] If Mltd and FlLd are simply set as the unlimited corrected desired floor reaction force's momenL Min and the 
unlimited corrected desired floor reaction force's horizontal component Fin, respectively, the desired floor reaction 
force's moment for compliance control does not remain within the floor reaction force's moment allowable range, or 
the floor reaction force's horizontal component for gait correction does not remain within the floor reaction force's 

10 horizontal component allowable limit. At this time, the perturbation model's stabilization moment for correcting body 
horizontal position Mpf and the perturbation model's stabilization moment for correcting body posture angle Mrf are 
obtained by substituting Min and Fin for Mltd and Fltd, respectively, in foregoing Equations a20 and a21 . Mpf and Mrf 
obtained in this manner need to be changed in order to allow the. desired floor reaction force's moment for compliance 
control to exist within the floor reaction force's moment allowable range and to allow the floor reaction force's horizontal 

15 component for gait correction to exist within the floor reaction force's horizontal component allowable limit. In this 
embodiment, it is prioritized at this time that Mrf coincides with the required value of perturbation model's stabilization 
moment for correcting body posture angle Mrfdrnd as much as possible, that is, correction of Mrf from Mrf dm d is 
minimized. 

[0591] The reason of above is as follows. 

20, [0592] A floor reaction force's moment which can be corrected by the perturbation model for correcting body posture 
angle 203 is relatively small If a large moment is corrected by this model, the body posture angle is largely changed. 
Therefore, it is preferable that correction of the simplified model's gait using the inverse full model 201 is performed 
possibly by adding the movement of the perturbation model for correcting body horizontal position 202 to the simplified 
model's gait if possible. Then, when the movement of the perturbation model for correcting body horizontal position 

25 202 is not sufficient for the correction, it is preferable that a movement of the perturbation model for correcting body 
posture angle 203 is added to the simplified model's gait to correct the simplified model's gait. Thus, it is preferable 
that recovery of the perturbation model for correcting body posture angle 203 (recovery to the reference body posture 
angle) is prioritized over recovery of the perturbation model for correcting body horizontal position 202 (recovery of the 
body horizontal position to the stable position). In other words, it is preferred to prioritize that Mrf, the manipulated 

30 amount for recovering the perturbation model for correcting body posture angle 203, is set to coincide with the required 
value of perturbation model's stabilization moment for correcting body posture angle Mrfdrnd as much as possible. 
[0593] Between Mpf and Mrf obtained by substituting Min and Fin for Mltd and Fltd, respectively, in Equations a20 
and a21 , only Mpf should be changed, while Mrf is not changed, in order to cause Mrf to coincide with the required 
value of perturbation model's stabilization moment for correcting body posture angle Mrfdrnd. 

35 [0594] Here, a change amount of Fltd is set as AF and a change amount of Mltd is set as AM. In other words, the 
Fltd and Mltd are changed as expressed by the following equations. 

Fltd- Fin + AF Equation a37 

40 

Mltd - Min + AM Equation a38 

[0595] Incidentally, the relation of the following equation is obtained from foregoing Equations a20 and a21 . 

45 

Mrf - Mltd - Mdmd - (Fltd-Ffull-F0)*h Equation a39 

[0596] As evident from above Equations a37to a3Q, Mrf is not changed as long as the following equation holds true. 
so In short, as long as the following equation holds true, Mrf is the same as Mrf where Fltd = Fin and Mltd = Min. 

AM = AF*h Equation a40 

55 [0597] Based on the above, AM and AF must satisfy above Equation a40. 

[0598] On top of this, it is preferred that Mpf is as close to the required value of perturbation model's stabilization 
moment for correcting body horizontal position Mpfdmd as possible. Therefore, the change amount AF (or AM) is 
determined to have a smallest possible absolute value. Further, Fltd and Mltd are determined using Equations a37 and 
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a38. Hence, at least the foregoing perturbation model's body posture angle for correction Oc is appropriately stabilized 
thus preventing divergence. In addition, the foregoing perturbation model's body horizontal position for correction Xc 
is stabilized as much as possible, thus preventing divergence. 

[0599] A group of Fltd and Mltd determined as above is shown as the black circle (Fltd Mltd) in Figs 53 and 54 
Among Intersection points between a fine passing through the white circle (Fin, Min) and having the body translation 
mode floor reaction force ratio h as lis inclination, and the border of the allowable range expressed by Equations a35 
and a36, the black circle is a point closesL to the white circle (Fin, Min),. 

[0600] Supplementary the above line means a set of the points (Fltd, Mltd) which satisfy Equations a37 a38 and 
a40. Further, when only the perturbation model's stabilization moment for correcting body horizontal position Mpf is 
changed from the state of the white circle, the ratio between the change amount AM of Mltd and the change amount 
AF of Fltd becomes the body translation mode floor reaction force ratio h. It is thus understood that the above line 
means a set of groups (Fltd, Mltd) where only the perturbation model's stabilization moment for correcting body hori- 
zontal position Mpf is changed from the state where (Fltd, Mltd) coincides with (Fin, Min). 

[0601] However, if there is no Fltd and Mltd satisfying Equations a35, a36, a37, a38 and a40 as shown in Fig 55 
Fltd and Mltd are determined as follows. In this case, Mr has to be changed but consideration is given to minimize the 
change amount of Mr. 

[0602] Therefore, Equation 41 is used instead of Equation a40. 
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20 AM = AF*h + AMp2 Equation a41 

[0603] Fltd and Mltd are determined to satisfy Equations a35, a36, a37, a38 and a41 . The closer AMp2 is to zero 
the smaller the change amount of Mr becomes. Thus : AMp2 is determined to have a smallest possible absolute value' 
On top of satisfying these conditions, it is also preferred that Mp is as close to the required value of perturbation model's 
stabilization moment for correcting body horizontal position Mpfdmd as possible. Hence, AF is determined to have a 
smallest possible absolute value. Accordingly, at least the forgoing perturbation model's body posture angle for cor- 
rection Gc is stabilized as much as possible, thus preventing divergence. On top of that, the foregoing perturbation 
model's body horizontal position for correction Xc is stabilized as much as possible, thus preventing divergence 
[0604] The group of Fltd and Mltd determined as above is represented by the black circle (Fltd Mltd) in Fig 55 The 
black circle is a point among apexes of the rectangular border of the allowable range (among intersection points of 
four lines showing upper and lower limits of the allowable range) expressed by Equations a35 and a36. (More generally 
the black circle is a point among points on the border line of the allowable range). This point is the closest point to the 
line passing thorough the white circle (Fin, Min) and having the body translation mode floor reaction force ratio h as 
its inclination. 

[0605] The limited corrected desired floor reaction force's moment Mltd and limited corrected desired floor reaction 
force's horizontal component Fltd about the desired ZMP are determined as described so far. 

[0606] Supplementary description is given. When the floor reaction force's vertical component is zero (during the 
floating period of the running gait), the upper limit values Mmax and Fmax, and lower limit values Mmin and Fmin of 
Equations a35 and a36 are zero. Thus, the limited corrected desired floor reaction force's moment Mltd about the 
desired ZMP and limited corrected desired floor reaction force's horizontal component Fltd are also zero. 
[0607] The above has been the details of the processing of S3038. 

[0608] Here, each variable in this embodiment corresponds to each variable explained in the second embodiment 
as follows. 
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(a) The required value of perturbation model's stabilization moment for correcting body posture angle Mrfdmd 
which is the output of the perturbation model control law for correcting body posture angle 207, corresponds to 
the required value of the model's body posture angle stabilization floor reaction force's moment ' 

(b) The required value of perturbation model's stabilization moment for correcting body horizontal position Mpfdmd 
which is the output of the perturbation model control law for correcting body horizontal position 206, corresponds 
to the required value of model's body horizontal position stabilization floor reaction force's moment.' 

(c) The perturbation model's stabilization moment for correcting body posture angle Mrf corresponds to the model's 
body posture angle stabilization floor reaction force's moment. 

(d) The model's stabilization moment for correcting body horizontal position Mpf corresponds to the model's body 
horizontal position stabilization floor reaction force's moment. 

[0609] Hereinbeiow, considering the above correspondence, it is proved that the corrected gait generated in this 
embodiment satisfies foregoing Equation d27 and recovery conditions. 

[0610] As evidentfrom Fig. 49, a movement of the corrected gait is a movement obtained by adding body movements 
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of the perturbation model for correcting body horizontal position 202 and perturbation model for correcting body posture 
angle 203 to a movement of the simplified model's gait. From a viewpoint of dynamics of the full model 201 , a floor 
reaction force generated about the desired ZMP by a movement of the simplified model's gait is the full-model's floor 
reaction force's moment Mfull, a floor reaction force generated by the body movement of the perturbation model for 
correcting body horizontal position 202 is the perturbation model's moment for correcting body horizontal position Mp, 
and a floor reaction force generated by the body movement of Lhe perturbation model for correcting body posture angle 
203 is the perturbation model's moment Tor correcting body posture angle Mr. 

[0611] Therefore, the floor reaction force's moment generated by a movement of the corrected gait, that is, model 
manipulation floor reaction force's moment is expressed by the following equation. 

Model manipulation floor reaction force's moment 
- full-model's floor reaction force's moment 
+ perturbation model's moment for correcting body horizontal 

position Mp 

+ perturbation model's moment for correcting body posture angle 

Mr Equation d31 

[0612] Moreover, as evident from Fig. 49, the following equation holds true. 

Perturbation model's moment for correcting body horizontal 

position Mp 

= model's stabilization moment for correcting body horizontal 

position Mpf 

- full-model's floor reaction force's moment Equation d32 

[061 3] Further, the perturbation model's moment for correcting body posture angle Mr coincides with the perturbation 
model's stabilization moment for correcting body posture angle Mrf. Specifically, the following equation is applied. 

Perturbation model's moment for correcting body posture angle Mr 
= perturbation model's stabilization moment for correcting body 

posture angle Mrf Equation d33 

[061 4] Accordingly, the following equation holds true from Equations d31 , d32 and d33. 

Model manipulation floor reaction force's moment 

= model's stabilization moment for correcting body horizontal 

position Mpf 

+ model's stabilization moment for correcting body posture angle 
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Mrf Equation d34 

[0615] Equation d34 corresponds to Equation d30 of the second embodiment. 

[0616] Supplementarily, in Fig. 49, in a case where the model's stabilization moment for correcting body horizontal 
position Mpf and perturbation model's stabilization moment for correcting body posture angle Mrf are both zero, a 
generated gait has zero moment about the desired ZMP. Therefore, the gait generated in the above case is equivalent 
to the original gait. 

[0617] Yet further, as evident from Fig. 49, the following equation holds true. 



Perturbation model's stabilization moment for correcting body 

posture angle Mrf 
= limited floor reaction force's moment Mltd 
- model's stabilization moment for correcting body horizontal 
20 position Mpf 

- compensated total floor reaction force's moment Mdmd Equation a35 



[0618] Thus, the following equation holds true from Equations d34 and d35. 

25 

Limited floor reaction force's moment Mltd 
= model manipulation floor reaction force's moment 

30 

+ compensated total floor reaction force's moment Mdmd Equation d36 

[0619] Incidentally, the limited corrected desired floor reaction force's moment Mltd is determined by the foregoing 

limiting means (limitation processing unit 21 1 ) not to exceed the floor reaction force's moment allowable range. There- 
sa fore, the right side of Equation d36 does not exceed the floor reaction force's moment allowable range either. Thus, 

the foregoing recovery condition 1 is satisfied. 
• [0620] Moreover, in this embodiment, the limited floor reaction force's moment Mltd is set as the desired floor reaction 

force's moment for compliance control. Thus, foregoing Equation d27 holds true by foregoing Equation d36. 

[0621] Meanwhile, as described earlier, the limited corrected desired floor reaction force's horizontal component Fltd 
40 is determined by the limiting means (limitation processing unit 21 1 ) not to exceed the floor reaction force's horizontal 

component allowable limit. 

[0622] Further, according to calculation processing until the perturbation model's moment for correcting body hori- 
zontal position Mp is determined from the limited corrected desired floor reaction force's horizontal component Fltd, 
. the floor reaction force's horizontal component of the corrected gait almost coincides with the limited corrected desired 

45 floor reaction force's horizontal component Fltd. 

[0623] Thus, the floor reaction force's horizontal component for corrected gait does not exceed the floor reaction 
force's horizontal component allowable limit. Thus, the foregoing recovery condition 2 is satisfied. 
[0624] Moreover, in the processing of the limiting means (limitation processing unit 211), on top of satisfying the 
recovery conditions 1 and 2, a moment obtained by subtracting the model's stabilization moment for correcting body 

50 horizontal position Mpf and compensated total floor reaction force's moment Mdmd from th e limited floor reaction force's 
moment Mltd, is determined to coincide with or to be a value close to the required value of the perturbation model's 
stabilization moment for correcting body posture angle Mrfdmd as much as possible. 

[0625] Therefore, on top of satisfying the recovery conditions 1 and 2, the perturbation model's stabilization moment 
for correcting body posture angle Mrf is determined to coincide with or to be a value ciose to the required value of 
55 perturbation model's stabilization moment for correcting body posture angle Mrfdmd as much as possible. Thus, the 
foregoing recovery condition 3 is satisfied. 

[0626] Moreover, according to calculation processing until the perturbation model's stabilization moment for correct- 
ing body horizontal position Mpf is determined from the required value of the perturbationmodel's stabilization moment 
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for correcting body horizontal position Mpfdmd, the perturbation model's stabilization moment for correcting body hor- 
izontal position Mp is determined by the limited means (limitation processing unit211) to coincide with or to be a value 
close to the required value of the perturbation model's stabilization moment for correcting body horizontal position 
Mpfdmd as much as possible, on top of satisfying the recovery conditions 1 , 2 and 3, Thus, the foregoing recovery 
5 condition 4 Is satisfied. 

[0627] Further, when inputs to the limiting means (limitation processing unit 211) are continuous, outputs thereof are 
also continuous. Thus, the foregoing recovery condition 5 is satisfied. 

[0628] As described above, all recovery conditions described earlier are satisfied inthis embodiment. Thus, the same 
operational advantages as those of the second embodiment can be achieved. 

10 [0629] In addition to the operational advantages of the second embodiment the calculation amount can be reduced 
when determining body horizontal position and body posture angle to satisfy the foregoing recovery conditions. 
[0630] Here, correspondence of the above-mentioned third embodiment to the present invention is described. The 
third embodiment corresponds to the foregoing first to fourteenth aspects and the sixteenth to twenty-third aspects of 
this invention. In this case, in the third embodiment, the body posture angle of the robot 1 is equivalent to the state 

15 quantity of the posture of the robot, the floor reaction force's horizontal component is equivalent to the variable to be 
limited, the perturbation model's moment for correcting body posture angle Mr and perturbation model's moment for 
correcting body horizontal position Mp are equivalent to the correction manipulated variable of the desired floor reaction 
force, the compensated total floor reaction force's moment Mdmd is equivalent to the first required manipulated variable, 
the floor reaction force's moment for compliance control is equivalent to the actual floor reaction force manipulated 

20 variable, and the required value of perturbation model's stabilization moment for correcting body position Mpfdmd and 
required value of perturbation model's stabilization moment for correcting body posture angle Mrfdmd are equivalent 
to the second required manipulated variable. In addition, the simplified model 200 (model in Fig. 10), the inverse full 
model 201 , the perturbation model for correcting body posture 203 and perturbation model for correcting body horizontal 
position 202 are used as the dynamic model. Movements of the simplified model 200, the perturbation model for cor- 

25 reeling body posture 203 and the perturbation model for correcting body horizontal position 202 include the body, 
translation mode and body rotation mode. Further, gait parameters are corrected as appropriate, depending on the 
state quantities of the corrected gait in the processing in S3028 in Fig. 48, 

[0631] Next, the fourth embodiment of this invention is described hereinbeiow. A correction method of the device in 
the fourth embodiment is different from that of the third embodiment described above only in processing of the gait 
30 generating device 100 (processing of S3038 in Fig. 48). This correction method is a full-model feedback correction 
type. In addition, in this method, the inverse dynamic full model (inverse full model) is used and inputs to the simplified 
model's gait are not corrected. Further, perturbation models are used in this method. 

[0632] Fig. 56 is a functional block diagram explaining the operation of the device according to the fourth embodiment, 

specifically, the correction method of the gait in S3038 of the flowchart in Fig. 48. Similarly to the third embodiment, 
35 the simplified model 200 in Fig. 56 represents not only the processing of the dynamic model, but also the processing 

from S3010 to S3034 in Fig. 48, that is, calculation (determination) processing of instantaneous values of the simplified 

model's gait. Therefore, in Fig. 56, processing after the simplified model 200 corresponds to the processing of S3038. 

Note that the functional parts in Fig. 56 which are the same as those in Fig. 49 of the third embodiment are denoted 

by the same reference symbols as those in Fig. 49 to omit the description thereof. 
40 [0633] The configurations other than the processing of S3038 are the same as those of the third embodiment, and 

thus description thereof is omitted. The processing of S3038 is detailed below using Fig. 56. 

[0634] In S3038, first of all, a perturbation model's body horizontal position for correction Xc calculated as described 
below in the last control cycle (time t-At) is added to an instantaneous value of a desired body horizontal position of a 
simplified model's gait obtained in S3032 in Fig. 48 as described earlier (provisional instantaneous value obtained in 

45 the control cycle at current time t), by a calculator 205. Thus, a final desired body horizontal position (corrected desired 
body horizontal position) is obtained. In addition, a later-described perturbation model's body posture angle for correc- 
tion Gc calculated in the last control cycle (time t-At) is added to an instantaneous value of a desired body posture angle 
of the simplified model's gait obtained in S3032 in Fig. 48 (provisional instantaneous value obtained in the control cycle 
at current time t). Thus, a final desired body posture angle (corrected desired body posture angle) is obtained. The 

50 corrected desired body horizontal position and corrected desired body posture angle are outputted as final desired 
instantaneous values of body horizontal position and body posture angle, respectively. 

[0635] In other words, the corrected desired body horizontal position and corrected desired body posture angle are 
obtained by Equations a24 and a25 described earlier. 

[0636] Next, inputted to the foregoing inverse dynamic full model 201 are instantaneous values of movement varia- 
55 bles of the desired body horizontal position (corrected desired body horizontal position), desired body posture angle 
(corrected desired body posture angle) obtained by correcting the simplified model's gait as above, desired center-of- 
gravity position, desired foot position/posture, desired arm positions and the like of the simplified model's gait, obtained 
as described earlier, and an instantaneous value of the desired ZMP. Thereafter, a floor reaction force's horizontal 
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component and floor reaction force's moment about the desired ZMP, which balance with a movement expressed by 
the inputted movement variables (that is, which are generated by the inverse full model 201 due to the movement), 
are calculated. Therefore, in this embodiment, the perturbation model's body horizontal position for correction Xc and 
perturbation model's body posture angle for correction Be, as well as the body horizontal position and body posture 
angle of the simplified model are additionally inputted to the inverse full model 201 . Hereinbelow, similarly to the third 
embodiment, the floor reaction force's horizontal component and floor reaction force's moment calculated by the inverse 
full model 201 are called full-model's floor reaction force's horizontal component Ffull and full-model's floor reaction 
force's moment Mfull, respectively. 

[0637] Between thef ull-modePs floor reaction force's horizontal component Ffull and full-model's floor reaction force's 
moment Mfull, the full-model's floor reaction force's horizontal component Ffull is outputted as a corrected desired floor 
reaction force's horizontal component (final desired instantaneous value of floor reaction force's horizontal component 
at current time t). 

[0638] In other words, the corrected desired floor reaction force's horizontal component is determined by thefollowing 
equation and outputted. 

Corrected desired floor reaction force's horizontal component 

= full-model's floor reaction force's horizontal component Ffull Equation a48 

[0639] As evident from the above processing, i n this embodiment, the full-model's gait is obtained by adding behaviors 
of the perturbation model for correcting body horizontal position 202 and perturbation model for correcting body posture 
angle 203 to the simplified model's gait.. Hence, the following equation holds true. The simplified model's floor reaction 
force's horizontal component is a translational force's horizontal component of a floor reaction force obtained by cal- 
. culating the floor reaction force generated by the movement of the simplified model's gait, using the inverse full model 
201. 



Full-model's floor reaction force's horizontal component Ffull 
= simplified model's floor reaction force's horizontal component 
4- perturbation model's floor reaction force's horizontal component 
35 for correcting body horizontal position Fp 

+ perturbation model's floor reaction force's horizontal component 

for correcting body posture angle Fr Equation a51 



[0640] Next, a required value of perturbation model's stabilization moment for correcting body horizontal position 
Mpfdmd is determined by the perturbation model control law for correcting body horizontal position 206. The pertur- 
bation model control law for correcting body horizontal position 206 in this embodiment is set as proposed in Patent 
Application No. 2001-133621 by the applicant of the present application concerned. For example, the control law 206 
45 is determined as the following equation. 

Required value of perturbation model's stabilization moment for 
50 correcting body horizontal position Mpfdmd 

- Kpg* center-of-gravity difference +- Kvg*perturbation model's 

body horizontal velocity for correction dXc/dt Equation a52 



where center-of-gravity difference is obtained in the following equation. 
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Center-of-gravity difference 

5 

= full-model's horizontal center-of-gravity position 
- simplified model's horizontal center-of-gravity position Equation a53 

10 

[0641] Kpg and Kvg in Equation a52 are gains of feedback control. The full-model's horizontal center-of-gravity po- 
sition, simplified model's horizontal center-of-gravity position, and perturbation model's body horizontal velocity for 
correction dXc/dt are the horizontal center-of-gravity position of the instantaneous value of fuli-model's gait, the hori- 
zontal center-of-gravity position of the instantaneous value of simplified model's gait (horizontal center-of-gravity po- 
15 sition XGs calculated using the simplified model, based on instantaneous posture of the simplified model's gait) and 
perturbation model's body horizontal velocity for correction dXc/dt, respectively, all calculated at the last time (time t- 
At) as described later. 

[0642] In other words, a feedback amount (manipulated amount) for controlling the perturbation model is calculated 
based on the center-of-gravity difference, obtained by subtracting the simplified model's horizontal center-of-gravity 
20 position from the full-model's horizontal center-of-gravity position, and the perturbation model's body velocity, one of 
states of the perturbation model. A time average of the center-of-gravity differences can be controlled to be almost 
zero by the perturbation model control law. 

[0643] Next, a required value of perturbation model's stabilization moment for correcting body posture Mrfdmd is 
determined by the perturbation model control law for correcting body posture angle 207. A control law similar to that 

25 of the first embodiment can be used. Thus, for example, Equation a11 is used as the control law 207. 

[0644] Next, an unlimited corrected desired floor reaction force's moment Min is obtained (estimated) by a Min cal- 
culator 209. Similarly to the third embodiment, the unlimited corrected desired floor reaction force's moment Min is a 
floor reaction force's moment which is generated about the desired ZMP when the perturbation model's stabilization 
moment for correcting body horizontal position Mpf is caused to coincide with the required value of perturbation model's 

30 stabilization moment for correcting body horizontal position Mpfdmd, the perturbation model's stabilization moment for 
correcting body posture angle Mrf is caused to coincide with the required value of perturbation model's stabilization 
momentfor correcting body posture angle Mrfdmd, and the desired floor reaction force's moment for compliance control, 
serving as the desired floor reaction force's moment about the desired ZMP, is caused to coincide with the total sum 
- of the compensated total floor reaction force's moment Mdmd, Mpf, and Mrf. At this time, the foregoing constraints 

35 (ZMP constraints and floor reaction force's horizontal component constraint) are ignored. 

[0645] The unlimited corrected desired floor reaction force's moment Min is obtained by calculation of foregoing 
Equation a13, similarly to the third embodiment. In other words, the unlimited corrected desired floor reaction force's 
moment Min is obtained by adding the required value of perturbation model's stabilization moment for correcting body 
horizontal position Mpfdmd, required value of perturbation model's stabilization moment for correcting body posture 

40 angle Mrfdmd, and the compensated total floor reaction force's moment Mdmd. 

[0646] Further, an unlimited corrected desired floor reaction force's horizontal component Fin is obtained (estimated) 
by a Fin calculator 21 0. Similarly to the third embodiment, the unlimited corrected desiredfloor reaction force's horizontal 
component Fin is a floor reaction force's horizontal component (equivalent to Ffull) which is generated by the inverse 
full model 201 when the perturbation model's stabilization momentfor correcting body horizontal position Mpf is caused 

45 to coincide with the required value of perturbation model's stabilization moment for correcting body horizontal position 
Mpfdmd, the perturbation model's stabilization moment for correcting body posture angle Mrf is caused to coincide 
with the required value of perturbation model's stabilization moment for correcting body posture angle Mrfdmd, and 
the desired floor reaction force's moment for compliance control is caused to coincide with the total sum of the com- 
pensated total floor reaction force's moment Mdmd, Mpf, and Mrf. Atthis time, the foregoing constraints (ZMP constraint 

so and floor reaction force's horizontal component constraint) are ignored. 

[0647] Unlike the third embodiment, the unlimited corrected desired floor reaction force's horizontal component Fin 
is obtained by the following equation. 

Unlimited corrected desired floor reaction force's horizontal 

55 

component Fin 
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- full-model's floor reaction force's horizontal component Ffull 

+ 1/h 

5 

* (required value of perturbation model's stabilization moment for 
correcting body horizontal position Mpfdmd - perturbation model's 
10 stabilization moment for correcting body horizontal position Mpf) Equation a54 

■ 

[0648] The value of the perturbation model's stabilization moment for correcting body horizontal position Mpf is the 
last value thereof (value at time t-At). Specifically, a difference between the required value of perturbation model's 
stabilization moment for correcting body horizontal position Mpfdmd and perturbation model's stabilization moment for 

15 correcting body horizontal position Mpf is obtained, and an input to the perturbation model for correcting body horizontal 
position is increased by the above difference. Because of the increase, the full-model's floor reaction force's horizontal 
component Ffull is increased. The increased amount of the full-model's floor reaction force's horizontal component 
Ffull is estimated by dividing the above difference by the body translation mode floor reaction force ratio h. In addition, 
the full-model's floor reaction force's horizontal component Ffull is added to the above increased amount, thus esti- 

20 mating the unlimited corrected desired floor reaction force's horizontal component Fin. 

[0649] Next, limited corrected desired floor reaction force's moment Mltd (about the desired ZMP) and limited cor- 
rected desired floor reaction force's horizontal component Fltd are determined by limiting means (limitation processing 
unit 211 ) similar to that of the third embodiment, from the unlimited corrected desired floor reaction force's moment 
Min and unlimited corrected desired floor reaction force's horizontal component Fin. Mltd and Fltd are values obtained 

25 by limiting Min and Fin, respectively, to satisfy the foregoing constraints (ZM P constraint and floor reaction force hor- 
izontal component constraint). This processing method is the same as that of the third embodiment. 
[0650] In this embodiment, the desired floor reaction force's moment for compliance control also coincides with the 
limited corrected desired floor reaction force's moment Mltd, and the corrected desired floor reaction force's horizontal 
component almost coincides.with the limited corrected desired floor reaction force's horizontal component Fltd. Thus, 

30 by determining the limited corrected desired floor reaction force's moment Mltd and limited corrected desired floor 
reaction force's horizontal component Fltd as described above, the desired floor reaction force's moment for compliance 
control and corrected desired floor reaction force's horizontal component almost satisfy the ZMP constraint and floor 
reaction force's horizontal component constraint, respectively. 

[0651] Next, the perturbation model's stabilization moment for correcting body horizontal position Mpf is obtained by 
35 . an Mpf calculator 215. To be more specific, a value obtained by subtracting the full-model's floor reaction force's hor- 
izontal component Ffull from the limited corrected desired floor reaction force's horizontal component Fltd, is multiplied 
by a gain Kc. The resulting value is integrated at the integrator 21 5a, and the integral thus obtained is further multiplied 
by the body translation mode floor reaction force ratio h. Thus, the perturbation model's stabilization moment for cor- 
recting body horizontal position Mpf is obtained. In other words, the perturbation model's stabilization moment for 
40 correcting body horizontal position Mpf is obtained by the following equation. 

Mpf = h* J Kc(Fltd-Ffull)dt Equation a55 

45 [0652] Next, the perturbation model's stabilization moment for correcting body posture angle Mrf is obtained by a 
Mrf calculator 214, by subtracting the perturbation model's stabilization moment for correcting body horizontal position 
Mpf and compensated total floor reaction force's moment Mdmd from the limited corrected desired floor reaction force's 
moment Mltd. In other words, the perturbation model's stabilization moment for correcting body posture angle Mrf is 
obtained by foregoing Equation a21 . 

so [0653] Further, the perturbation model's floor reaction force's moment for correcting body posture angle Mr is deter- 
mined by foregoing Equation a23. In other words, the perturbation model's stabilization moment for correcting body 
posture angle Mrf, which is the output of the Mrf calculator 214, is determined as it is as the perturbation model's floor 
reaction force's moment for correcting body posture angle Mr. 

[0654] Next, a full-model's floor reaction force's moment error Merr defined by the following equation is calculated 
55 by a Merr calculator 216. 

Full-model's floor reaction force's moment error Merr 
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= full-model's floor reaction force's moment Mfull - limited 

corrected desired floor reaction force's moment M ltd Equation a56 

[0655] Next, the perturbation model's floor reaction force's moment for correcting body horizontal position Mp is 
obtained by a Mp calculator 21 7, in accordance with the following equation. 

Mp = Mpf - jKm*Merr dt Equation a57 



[0656] Specifically, a value obtained by multiplying the full-model's floor reaction force's moment error Merr by the 
integral gain Km is integrated at an integrator 217a, and the sign of the resulting integral is changed. Further, the output 
of the integrator 217a is added to the perturbation model's stabilization moment for correcting body horizontal position 

15 Mpf, thus obtaining the perturbation model's floor reaction force's moment for correcting body horizontal position Mp. 
[0657] Next, the perturbation model's floor reaction force's moment for correcting body horizontal position Mp is 
inputted to the perturbation model for correcting body horizontal position 202. Thus, the perturbation model's body 
position for correction Xc which balances with the inputted floor reaction force's moment is calculated. 
[0658] The perturbation model's floor reaction force's moment for correcting body posture angle Mr is inputted to the 

20 perturbation model for correcting body posture angle 203. Thus, the perturbation model's body posture angle for cor- 
rection 0c which balances with the inputted floor reaction force's moment is calculated. 

[0659] The perturbation model's body position for correction Xc, the perturbation model's body posture angle for 
correction Gc, and the perturbation model's stabilization moment for correcting body horizontal position Mpf are' used 
as the last values at the next control cycle (at time t+At), as described earlier. 

25 [0660] The rest of the configurations and processing are the same as those of the third embodiment. According to 
the fourth embodiment, operational advantages similar to those of the third embodiment can be achieved. 
[0661] Here, correspondence of the above-described fourth embodiment to the present invention is described. The 
fourth embodiment corresponds to the foregoing first to tenth, and twelfth to seventeenth aspects of this invention. In 
this case, in the fourth embodiment, the body posture angle of the robot 1 is equivalent to the state quantity of the 

30 posture of the robot, the floor reaction force's horizontal component is equivalent to the variable to be limited, the 
perturbation model's moment for correcting body posture angle Mr and perturbation model's moment for correcting 
body horizontal position Mp are equivalent to the correction manipulated variable, the compensated total floor reaction 
force's moment Mdmd is equivalent to the first required manipulated variable, the floor reaction force's moment for 
compliance control is equivalent to the actual floor reaction force manipulated variable, the required value of pertur- 

35 bation model's stabilization moment for correcting body horizontal position Mpfdmd and required value of perturbation 
model's stabilization moment for correcting body posture angle Mrfdmd are equivalent to the second required manip- 
ulated variable. Further, the simplified model 200 (model in Fig. 1 0), the inverse full model 201 , the perturbation model 
for correcting body posture 203, and the perturbation model for correcting body horizontal position 202 are used as 
dynamic models. The movements of the simplified model 200, perturbation model for correcting body posture 203 and 

40 perturbation model for correcting body horizontal position 202 include the body translation mode and body rotation 
mode. In addition, gait parameters are corrected as appropriate by the processing of S3028 in Fig. 48. 
[0662] Next, the fifth embodiment of the present invention is described with reference to Figs. 57 and 58. The fifth 
embodiment is a method of generating a gait while correcting the gait using a direct dynamic model (more precisely, 
pseudo direct dynamic model), instead of using the inverse dynamic full model (inverse full model) used in the afore- 

45 mentioned third and fourth embodiments. 

[0663] Fig. 57 is a functional block diagram explaining the operation of the device of the fifth embodiment. As shown 
in Fig. 57, the pseudo direct full model (pseudo direct dynamic full model) 222 is provided in this embodiment. 
[0664] Inputs of this pseudo direct full model 222 are the required value of body horizontal position stabilization 
moment Mpfdmd, required value of body posture angle stabilization moment Mrfdmd, desired ZMP, desired floor re- 

50 action force's vertical component, and compensated total floor reaction force's moment Mdmd, as well as movement 
states of portions apart from the body 24, such as desired foot position/posture and desired arm postures. The pseudo 
direct full model 222 outputs desired body vertical position, desired body horizontal position, desired body posture 
angle, desired floor reaction force's moment for compliance control as a desired floor reaction force about the desired 
ZMP, and desired floor reaction force's horizontal component. The inputs of the pseudo direct full model 222 are gen- 

55 erated by the desired instantaneous value generator 1 00b based on the gait parameters determined in the gait param- 
eter determinator 1 00a, as described with reference to foregoing Fig. 47. 

[0665] The above-descnbed pseudo direct full model 222 is specifically shown by the functional block diagram in 
Fig. 58. Note that.the func^onal parts in this functional block diagram, which are the same as those in Fig. 56 of the 
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foregoing fourth embodiment, are denoted by the same reference symbols as those in Fig. 56. 
[0666] Here, the simplified model 200 in Fig. 58 represents not only the dynamic model, but also the processing from 
S3010to S3034 of foregoing Fig. 48, that is, the calculation (determination) processing of instantaneous values of the 
simplified model's gait. Further, in the calculation (determination) processing of instantaneous values of current time 
gait (instantaneous values of simplified model's gait) in S3032, the model manipulation floor reaction force's moment 
aboul the desired ZMP is set to be zero and instantaneous values of the gait are generated, as described in the 
foregoing third embodiment. Further, a perturbation movemenL in Lhe body rotation mode is added to the instantaneous 
values of the gait. This perturbation movement generates (the last value of) perturbation model's moment for correcting 
body posture angle Mr which corresponds to the perturbation model's moment for correcting body posture angle Mr 
described in the third embodiment. In addition, a perturbation movement in the body translation mode is added to the 
instantaneous values of the gait. This perturbation movement generates (the last value of) a moment for correcting 
simplified model's body horizontal position Mp which corresponds to the perturbation model's moment for correcting 
body horizontal position Mp described in the third embodiment. Thus, the instantaneous values of the gait outputted 
by the simplified model 200 are corrected. 

[0667] To be more specific, in the processing of S3032 in Fig. 48 in this embodiment, the instantaneous value of the 
body horizontal position at current time t is obtained in the following manner in S1 01 4 in Fig. 40, subroutine processing 
of S3032 in Fig. 48. A body horizontal acceleration (d2Xb/dt2) is obtained based on an equation expressing that the 
second term on the right side of forgoing Equation 03 is equal to (the last value of) Mp, that is, an equation Mp=mb* 
(Zb-Zzmp)*(d2Xb/dt2). This body horizontal acceleration is added as a perturbation to the body horizontal acceleration 
obtained in the simplified model 200. The resultant body horizontal acceleration is then second-order integrated from 
the beginning of the current time gait up to current time t, thus obtaining the instantaneous value of body horizontal 
position at current time t. Further, in S1014 in Fig. 40, a body posture angular acceleration (d26by/dt2) Is obtained 
based on an equation which expresses that the seventh term on the right side of foregoing Equation 03 is equal to (the 
last value of) Mr, that is an equation Mr=J*d2Gby/dt2. The body posture angular acceleration is added as a perturbation 
to the body posture angular acceleration obtained by the simplified model 200. The resultant body posture angular' 
acceleration is second-order integrated from the beginning of the current time gait up to current time t thus obtaining 
an instantaneous value of body posture angle at current time t. 

[0668] In Fig. 58, portions after the simplified model 200 are those which execute processing which corresponds to 
the processing of S3038. The processing of S3038 is detailed below using Fig. 58. 

[0669] In S3038, first of all, in S3032, a simplified model's body horizontal position, corrected based on the moment 
for correcting simplified model's body horizontal position Mp (specifically, the last value in control cycle at time (t-At)), 
is outputted as a desired body horizontal position (final desired instantaneous value of body horizontal position at time 
t), as described earlier. In addition, a simplified model's body posture angle, corrected based on the perturbation model's 
moment for correcting body posture angle Mr (specifically, the last value in control cycle at time (t-At)), is outputted as 
a desired body posture angle (final desired instantaneous value at body posture angle at time t). 
[0670] In other words, final desired body horizontal- position and desired body posture angle are determined by Equa- 
■ tions a100 and a101. 

40 Desired body horizontal position 

= simplified model's body horizontal position Equation a100 

45 . Desired body posture angle 

= simplified model's body posture angle Equation a1 01 
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[0671 ] Next, inputted to the foregoing inverse dynamic full model' (inverse full model) 201 are the desired body hor- 
izontal position (that is, simplified model's body horizontal position), desired body posture angle (that is, simplified 
model's body posture angle), the instantaneous values of movement variables of the desired total center of gravity, 
desired foot position/posture, desired arm postures and the like of the simplified model's gait obtained as described 
earlier, as well as an instantaneous value of the desire ZMP, Thereafter, a floor reaction force's horizontal component 
and floor reaction force's moment about the desired ZMP, which balance with a movement expressed by the inputted 
movement variables (that is, which are generated by the inverse full model 201 due to the movement), is calculated. 
Hereinbelow, similarly to the fourth embodiment, these calculated floor reaction force's horizontal component and floor 
reaction force's moment are referred to as full-model's floor reaction force's horizontal component Ff ui! and full-model's 
floor reaction force's moment Mfull, respectively. 
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[0672] Similarly to the fourth embodiment, the full-model's floor reaction force's horizontal component Ffull is out- 
putted as a desired floor reaction force's horizontal component (final desired instantaneous value of floor reaction 
force's horizontal component at time t). 

[0673] In this embodiment, the perturbation model for correcting body posture angle and perturbation model for 
s correcting body horizontal position are not provided. Thus, processing corresponding to perturbation model control law 
for correcting body horizontal position and perturbation model control law for correcting body posture angle is different 
from that in the fourth embodiment. 

[0674] Apart from above, processing which is the same as the processing in the fourth embodiment for determining 
the perturbation model's moment for correcting body posture angle Mr and perturbation model's moment for correcting 

10 body horizontal position Mp is executed afterthe above-described processing, until the moment for correcting simplified 
model's body posture angle Mr and moment for correcting simplified model's body horizontal position Mp are deter- 
mined. In other words, processing of Min calculator 209, Fin calculator 210, limitation processing unit 211 (limiting 
means), Mpf calculator 215, Merr calculator 216, Mrf calculator 217 (= Mr calculator), and Mp calculator 214 is the 
same as that of the fourth embodiment. Note that Mr and Mp correspond to the perturbation model's moment for 

15 correcting body posture angle Mr and perturbation model's moment for correcting body horizontal position Mp in the 
fourth embodiment, respectively. However, Mr and Mp are not inputted to the perturbation models like in the fourth 
embodiment, but inputted to the simplified model 200. Therefore, in this embodiment, Mr and Mp are referred to as 
the moment for correcting simplified model's body posture angle and the moment for correcting simplified model's body 

horizontal position, respectively. 

20 [0675] The perturbation model's moment for correcting body posture angle Mr and the moment for correcting sim- 
plified model's body horizontal position Mp obtained as above are used as last values when determining (generating) 
the instantaneous values of the simpiified model's gait in the next control cycle (time t+At) as described earlier. 
[0676] The rest of the configurations and processing are the same as those in the fourth embodiment. 
[0677] Hereinbelow, determination processing of the required value of body posture angle stabilization moment Mr- 

25 fdmd and the required value of body horizontal position stabilization moment Mpfdmd is described with reference to 
Fig. 57. 

[0678] As shown in Fig. 57, in this embodiment, a simplified model 223 is provided in addition to the simplified model 
200 provided in thepseudo direct full model 222 as described earlier. In this embodiment, the function of the simplified 
model 223 is the same as that of the above-described simplified model 200. The simplified model 223 represents not 
30 only the dynamic model but also the processing from S3010 to S3034 in foregoing Fig. 48, that is, the calculation 
(determination) processing of instantaneous values of the simplified model's gait. Note that the simplified model 223 
is only required to be able to determine instantaneous values of body posture angle and body horizontal position, and 
does not necessarily perform the entire processing from S3010 to S3034 in Fig, 43. 

[0679] Hereinbelow, determination processing of Mpfdmd and Mrfdmd in this embodiment is detailed using Fig. 57. 

35 [0680] Differences in body horizontal position and body posture angle between a gait generated by using the sim- 
plified model 223 and a gait calculated by using the foregoing pseudo direct dynamic full model 222 as described 
earlier, are obtained by calculators 224 and 225, respectively. Thereafter, in accordance with the differences, a required 
value of body horizontal position stabilization moment Mpfdmd and required value of body posture angle stabilization 
moment Mrfdmd are determined by feedback control laws, such as PID, so that the differences converge to zero. In 

40 other words, Mpfdmd is obtained by a body horizontal position stabilization control law 226 made up of the feed back 
control law, in accordance with the difference between the body horizontal position by the simpiified model 223 and 
the body horizontal position by the pseudo direct fulf model 222. Further, Mrfdmd is obtained by a body posture angle 
stabilization control law 227 made up of the feedback control law, in accordance with the difference between the body 
posture angle by the simplified mode! 223 and the body posture angle by the pseudo direct full model 222. The Mpfdmd 

45 and Mrfdmd thus determined are then fed back and inputted to the aforementioned pseudo direct dynamic full model. 
[0681] Note that, in this embodiment, the gait generating device 1 00 outputs the desired ZMP, desired floor reaction 
force's vertical component, desired foot position/posture, desired arm postures and the like, which are a part of inputs 
to the foregoing pseudo direct dynamic full model 222. The gait generating device 100 also outputs the desired body 
vertical position, desired body horizontal position, desired body posture angle, desired floor reaction force's horizontal 

50 component and desired floor reaction force's moment for compliance control, which are outputs from the foregoing 
pseudo direct dynamicfull model 222. These are outputted as final desired instantaneous values of the currenttime gait. 
[0682] According to the fifth embodiment described above, operational advantages similar to those of the foregoing 
fourth embodiment can be achieved. 
' [0683] Here, correspondence of the above-described fifth embodiment to the present invention is described. The 

55 fifth embodiment corresponds to the foregoing first to fourteenth aspects and the sixteenth to twenty-third aspects of 
this invention. In this case, in the fifth embodiment, the body posture angle of the robot 1 is equivalent to the state 
quantity of the posture of the robot, the floor reaction force's horizontal component is equivalent to the variable to be 
limited, the momentfor correcting simplified model's body posture angle Mr and moment for correcting simplified mod- 
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el's body horizontal position Mp are equivalent to the correction manipulated variable of the desired floor reaction force, 
the compensated total floor reaction force's moment Mdmd is equivalent to the first required manipulated variable, the 
floor reaction force's moment for compliance control is equivalent to the actual floor reaction force manipulated variable, 
and the required value of body horizontal position stabilization moment Mpfdmd and required value of body posture 
angle stabilization moment Mrfdmd are equivalent to the second required manipulated variable. In addition, the pseudo 
direct full model 222 including the simplified model 200 and inverse full model 201 , and the simplified model 223 are 
used as the dynamic model. The simplified models 200 and 223 include the body translation mode and body rotation 
mode. Further, gait parameters are corrected by the processing of S3028 in Fig. 48, as appropriate. 
[0684] Note that, in the foregoing fifth embodiment, the required value of body posture angle stabilization moment 
Mrfdmd and body horizontal position stabilization moment Mpfdmd are inputted only to the pseudo direct full model 
222. However, Mrfdrn and Mpfdmd may be inputted to the simplified model 223, or distributed and supplied to the 
simplified model 223 and pseudo direct full model 222. 

[0685] Next, the sixth embodiment of the present invention is described with reference to Fig. 59. Fig. 59 is afunctional 
block diagram for explaining the operation of the device in the sixth embodiment of this invention, specifically, the 
correction method of a gait in S3038 of the flowchart in Fig. 48. Note that, in Fig. 59, the same functional parts as those 
of the third or fourth embodiment are denoted by the same reference symbols as those in Fig. 49 or Fig. 56. 
[0686] In the sixth embodiment, the perturbation model for correcting body horizontal position 202 and perturbation 
model for correcting body posture angle 203 are provided. In addition, two distributors 220 and 221 are provided. 
[0687] The distributors 220 and 221 are defined. Each distributor is a transmission block with one input and two 
outputs, and determines one output in accordance with the input (for example, determines one output by performing 
signal processing with frequency characteristics, dead band characteristics, saturation characteristics or the like on 
the input), and then determine the other output so that the sum of two outputs coincides or almost coincides with the 
input. 

[0688] An input to the distributor 220 is a moment for correcting body posture angle Mr (output of a Mr calculator 
214), obtained by subtracting the perturbation model's stabilization moment for correcting body horizontal position Mpf 
and the compensated total floor reaction force's moment Mdmd from the limited corrected desired floor reaction force's 
moment Mltd. The moment for correcting body posture angle Mr is then distributed into a perturbation model's input 
for correcting body posture angle Mri to be inputted to the perturbation model for correcting body posture angle 203 
and the moment for correcting simplified model's body posture angle Mrs to be inputted to the simplified model 200. 
Atthis time, the perturbation model's input for correcting body posture angle Mri and the moment for correcting simplified 
model's body posture angle Mrs are determined (outputted) so that the sum of the perturbation model's input for cor- 
recting body posture angle Mri and the moment for correcting simplified model's body posture angle Mrs coincides 
with the moment for correcting body posture angle Mr. 

[0689] To be more specific, the perturbation model's input for correcting body posture angle Mri is determined in 
accordance with the moment forcorrecting body posture angle Mr. For example, the moment for correcting body posture 
angle Mr is put through signal processing having dead band characteristics, saturation characteristics, or frequency 
characteristics, thus determining the perturbation model's input for correcting body posture angle Mri. In addition, the 
perturbation model's input for correcting body posture angle Mri is subtracted from the moment for correcting body 
posture angle Mr, and the resulting value is determined as the moment for correcting simplified model's body posture 
angle Mrs. More specifically, in this embodiment, the distributor 220 outputs a low frequency component (direct current 
component) obtained by passing the input (moment for correcting body posture angle Mr=Mltd-Mpf-Mdmd) through a 
low pass filter, as the moment for correcting simplified model's body posture angle Mrs. At the same time, a component 
obtained by subtracting Mrs from the input (moment for correcting body posture angle Mr) is outputted as the pertur- 
bation model's input for correcting body posture angle Mri. In this case, the moment for correcting simplified model's 
body posture angle Mrs, which is the low frequency component (direct current component) , is provided with dead band 
characteristics. Thus, where the output of the abovementioned low pass filter is within a predetermined range having 
a predetermined value as the center thereof, Mrs is maintained to be the predetermined value (for example, zero). 
[0690] The perturbation model's input for correcting body posture angle Mri, the output of the distributor 220, is 
inputted to the aforementioned perturbation model for correcting body posture angle 203, and the perturbation model's 
body posture angle for correction 0c is determined by the perturbation model for correcting body posture angle 203. 
[0691] The moment for correcting simplified model's body posture angle Mrs, the other output of the distributor 220, 
is inputted to the simplified model 200. This is equivalent to inputting the moment for correcting simplified model's body 
posture angle Mr to the simplified model 200 in Fig. 58 in the foregoing fifth embodiment. 

[0692] A value obtained by multiplying the full-model's floor reaction force's moment error Merr by a gain Km is 
integrated by the integrator 21 7a, and the sign of the resulting value is changed. The value thus obtained is the input 
to the distributor 221 . 

[0693] As in the case of the distributor 220, the input to the distributor 221 is distributed into the moment for correcting 
simplified model's body horizontal position Mps to be inputted to the simplified model 200, and the error correction 
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moment Me to be inputted to the perturbation mode! for correcting body horizontal position 202. To be more specific, 
the error correction moment Me is determined in accordance with the output of the integrator 217a. For example, the 
output of the integrator 21 7a (input to the distributor 220) is put through signal processing having dead band charac- 
teristics, saturation characteristics, or frequency characteristics, thus determining the error correction moment Me. In 

5 addition, the error correction moment Me is subtracted from the output of the integrator 21 7a, and the resulting value 
is determined as the moment for correcLing simplified model's body posLure angie Mrs. More specifically, in this em- 
bodiment, the distributor 221 outputs a low frequency component (direct current component) obtained by passing the 
input (output of the integrator 21 7a) through a low pass filter, as the moment'for correcting simplified model's body 
horizontal position Mps. At the same time, a component obtained by subtracting Mps from the input (output of the 

10 integrator 217a) is putputted as the error correction moment Me. In this case, the moment for correcting simplified 
model's body horizontal position Mps, which is the low frequency component (direct current component), is provided 
with dead band characteristics. Thus, where the output of the abovementioned low pass filter Is within a predetermined 
range having a predetermined value as the center thereof, Mps is maintained to be the predetermined value (for ex- 
ample, zero). 

15 [0694] In the Mp calculator 217b, the model's stabilization moment for correcting body horizontal position Mpf is 
added to the error correction moment Me, the output of the distributor 221 . Thus, the perturbation model's moment for 
correcting body horizontal position Mp is obtained. Thereafter, the perturbation model's moment for correcting body 
horizontal position Mp is inputted to the perturbation model for correcting body horizontal position 202. Thus, the per- 
turbation model's body horizontal position for correction Xc is determined by the perturbation model for correcting body 

20 horizontal position 202. 

[0695] The moment for correcting simplified model's body horizontal position Mps, the other output of the distributor 
221 , is inputted to the simplified model 200. This is equivalent to inputting the moment for correcting simplified model's 
body horizontal position Mp to the simplified model 200 in Fig. 58 in the foregoing fifth embodiment. 
[0696] As in the case of the fifth embodiment, in the calculation (determination) processing of instantaneous values 

25 of the simplified model's gait, the simplified model 200 generates instantaneous values of the gait so that a floor reaction 
force's moment is not generated' about the desire ZMP (the model manipulation floor reaction force's moment is zero). 
On top of this, a perturbation movement of the body rotation mode, which generates (the last value of) the moment for 
correcting simplified model's body posture angle Mrs, is added to the instantaneous values. At the same time, a per- 
turbation movement of the body translation mode ; which generates (the last value of) the moment for correcting sim- 

30 plified model's body horizontal position Mps, is added to the instantaneous values.. Thus, the instantaneous values of 
the gait are corrected. 

[0697] In this embodiment, in S800 in Fig. 35, a part of the processing of S3028 in Fig. 48, the state of the simplified 
model at the end of the last time gait are used as the end state of the iasttime gait. Therefore, if Mrs and Mps outputted 
from the distributors 220 and 221 to the simplified model are values other than zero, the simplified model Is shifted 
35 from the- original behavior. Hence, gait parameters are corrected in S3028 as appropriate, depending on the shift. 
Further, if ranges of the aforesaid dead band are set to be large, the absolute values of Mrs and Mps become small. 
Thus, absolute values of correction amounts of the gait parameters also become small. 

[0698] The other configuration and processing are the same as those of the fourth embodiment. To be more specific, 
the processing of the calculators 204 and 205, Merr calculator 21 6, perturbation model control law for correcting body 

40 posture angle 207, perturbation model control law for correcting body horizontal position 206, Min calculator 209, Fin 
calculator 21 0, limit processing unit 21 1 , and Mpf calculator 21 5 is the same as that of the foregoing fourth embodiment. 
[0699] Note that, in this embodiment, there is no need to perform processing for correcting the states of the simplified 
model 200 by way of the states of the respective perturbation models 202 and 203 at the end of the current time gait 
' or the like, as described in the foregoing third embodiment. This is because, the moment for correcting simplified 

45 model's body posture angle Mrs and moment for correcting simplified model's body horizontal position Mps are addi- 
tionally inputted from the distributors 220 and 221 . 

[0700] In this embodiment, operational advantages similar to those of the foregoing fourth or fifth embodiment can 
be achieved. 

[0701] Note that, in this embodiment, one of the two outputs from each of the distributors 220 and 221 may be set 

50 to be zero so that the other output is caused to coincide with the input. 

[0702] In this case, if, for example, the moment for correcting simplified model's body posture angle Mrs, the output 
of the distributor 220, and the moment for correcting simplified model's body horizontal position Mps, the output of the 
distributor 221, are set to be zero, the operational advantages as those of the fourth embodiment can be achieved. 
• .(The configuration becomes practically the same as that of the fourth embodiment.) 

55 [0703] Further, the moment for correcting simplified model's body posture angle Mrs, the output of the distributor 
220, and the error correction moment Me, the output of the distributor 221 , may be set to be zero. In this case, the 
perturbation model for correcting body posture angle can be omitted. 

[0704] Yet further, the perturbation model's input for correcting body posture angle Mri, the output of the distributor 
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220, and the moment for correcting simplified model's body horizontal position Mps, the output of the distributor 221 , 
may be set to be zero. 

[0705] Yet further, it is also possible that the value obtained by adding the model's stabilization moment for correcting 
body horizontal position Mpf to the error correction moment Me is inputted to an unillustrated third distributor, the one 

5 of the outputs of the distributor is inputted to the perturbation model for correcting body horizontal position and the 
other output is added to the moment for correcting simplified model's body horizontal position Mps, In this case, the 
moment for correcting simplified model's body horizontal position Mps, the output of the distributor 221 , may be zero. 
In other words, it. may be possible that the distributor 221 is omitted and a value obtained by multiplying the full-model's 
floor reaction force's moment error Merr by the gain Km is integrated and the sign of the resulting value is changed. 

10 The value thus obtained is added to the model's stabilization moment for correcting body horizontal position Mpf, and 
the resulting value may be inputted to the third distributor. 

[0706] Here, correspondence of the above-described sixth embodiment to the present invention is described. The 
sixth embodiment corresponds to the foregoing first to fourteenth aspects and the sixteenth to twenty-third aspects of 
the present invention. In this case, in the sixth embodiment, the body posture angle of the robot 1 is equivalent to the 

15 state quantity of the posture of the robot, the floor reaction force's horizontal component is equivalent to the variable 
to be limited, the moment for correcting simplified model's body posture angle Mrs, moment for correcting simplified 
model's body horizontal position Mps, perturbation model's input for correcting body posture angle Mri, and perturbation 
model's moment for correcting body horizontal position Mp are equivalent to the correction manipulated variable of the 
desired floor reaction force, the compensated total floor reaction force's moment Mdmd is equivalent to the first required 

20 manipu lated variable, the floor reaction force's moment for compliance control is equivalent to the actual floor reaction 
force manipulated variable, the required value of perturbation model's stabilization moment for correcting body. hori- 
zontal position Mpfdmd and required value of the perturbation model's stabilization moment for correcting body posture 
angle Mrfdmd are equivalent to the second required manipulated variable. Further, the simplified model 200 (model in 
Fig. 10), inverse full model 201, perturbation model for correcting body posture 203, the perturbation model for cor- 

25 recting bodyhorizontal position 202 are used as the dynamic model. Movements of the simplified model 200, pertur- 
bation model for correcting body posture 203 and perturbation model for correcting body horizontal position 202 include 
the body translation mode and body rotation mode. In addition, gait parameters are corrected as appropriate by the 
processing of S3028 in Fig. 48. 

[0707] In the first to sixth embodiments described so far, the compensated total floor reaction force's moment Mdmd 
30 may be determined based on overstates related to the posture of the robot 1 , such as total horizontal center-of-gravity 
position and velocity, in stead of the body posture angle and angular velocity. 

[0708] In the aforementioned third to sixth embodiments, the gait generating devices of the first and second examples 
. of Japanese Patent Laid-Open Publication No. Heisei 5-337849, earlier proposed by the applicant of the present ap- 
plication concerned, may be used for gait generation by the simplified model 200 (simplified model gait generation). A 
35 correction amount by the full model can be reduced, thus preventing the corrected gait from largely shifting from the 
simplified model's gait. 

[0709] In the foregoing first embodiment, if the compensated total floor reaction force's moment Mdmd exceeds the 
floor reaction force's moment allowable range (in the second embodiment and the embodiments that follow, if the sum 
of the compensated total floor reaction force's moment Mdmd and model manipulation floor reaction force's moment 

40 exceeds the floor reaction force's moment allowable range), the desired floor reaction force's moment for compliance 
control becomes the upper or lower limit value of the floor reaction force's moment allowable range. However, even 
where the compensated total floor reaction force's moment Mdmd (in the second embodiment and the embodiments 
that follow, the sum of the compensated total floor reaction force's moment Mdmd and model manipulation floor reaction 
force's moment) exceeds the floor reaction force's moment allowable range, the desired floor reaction force's moment 

45 for compliance control may be set to increase or decrease corresponding to an increase or decrease of the compen- 
sated total floor reaction force's moment Mdmd (in the second embodiment and the embodiments that follow, the sum 
of the compensated total floor reaction force's moment Mdmd and model manipulation floor reaction force's moment). 
This is because, when the desired floor reaction force's moment for compliance control becomes close to the floor 
reaction force's moment allowable range, the actual floor reaction force's moment controlled by the compliance control 

50 tends to be slightly smaller than the desired value. Therefore, even where the desired floor reaction. force's moment 
for compliance control slightly exceeds the allowable range, it is often the case where problems, such as lowering foot 
22's original sense of contact with the floor and raising foot 22's bottom surface, do not occur immediately. ■ 
[0710] For reasons similar to above, the floor reaction force's moment allowable range may be set, exceeding a 
allowable range which is obtained by converting the range where ZMP can exist (strictly, the range where the point of 

55 action of the actual floor reaction force can exist) represented by the so-called support polygon, into a moment. 

[0711] Excessive dependence on the floor reaction force's moment generated by the compliance control results in 
the problems, such as lowering foot 22's original sense of contact with the floor and raising foot 22's bottom surface, 
as described earlier. Therefore, it can be said that the floor reaction force's moment allowable range is such a allowable 
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range of the actual floor reaction force's moment that posture control expects from compliance control. 
[071 2] The floor reaction force's moment allowable range may be determined based on not only gait parameters but 
also detected actual floor reaction force. Alternatively, the floor reaction force's moment allowable range may be de- 
termined based on detected values of a floor contacting region of the foot 22, such as detected values of edge positions 
5 of stairs. 

[0713] The processing of the main flowchart may be changed so that correction of current lime gait parameters 
(correction of the desired ZMP) in S028 in Fig. 12 in the foregoing first embodiment is performed for each control cycle. 
[0714] When the corrected gait (desired gait) largely deviates (diverges) from the original gait, the corrected gait 
ends up with having too large deviation (too large divergence) when gait parameters of the next time gait are corrected. 
10 Hence, merely correcting gait parameters of the next time gait leaves it difficult to continuously generate stable desired 
gaits over a long period of time. This problem can be solved to a great extent by correcting current time gait parameters 
(by correcting the desired ZMP) for each control cycle. 

[0715] Furthermore, foot landing position and landing time of the current time gait may be changed for each control 
. cycle, depending on the extent of the deviation of the corrected gait from the originai gait. 

15 [0716] Specifically, the processing flow is changed to execute the processing from S020 to S029 for each control 
cycle. Thereafter, it is sufficient that at least any one of the next time gait's supporting leg coordinate system (the next 
time gait's supporting leg coordinate system corresponds to the next foot landing position/posture), next but one time 
gait's supporting leg coordinate system (next but one time gait's supporting leg coordinate system corresponds to the 
foot landing position/posture after the next), current time gait's period {current time gait's period corresponds to the 

20 next foot landing time), and next time gait's period (next time gait's period corresponds to the cycle of the normal gait) 
is changed as appropriate so that correction of the current time gait parameters (correction of the desired ZMP, in 
particular) in S028 becomes small (that is, stability margin of the current time gait is maintained high). 
[0717] Yet further, gait parameters other than above may be changed. 

[0718] The deviation of the corrected gait from the original gait can be estimated by the use of the dynamic model 
25 from the moment for correcting simplified model's body posture angle Mr, the moment for correcting simplified model's 
body horizontal position Mp and the like. Thus, deviation in behavior of the model is estimated in accordance with Mr 
and Mp, and gait parameters may be corrected based on the estimated deviation in behavior. Alternatively, a relation 
between Mr, Mp and appropriate values of correction amounts of gait parameters is obtained in advance and mapped. 
Thereafter, based on the map, correction amounts of gait parameters may be set in accordance with Mr and Mp. 
so [0719] Further, processing flow may be changed in the other embodiments (the second to sixth embodiments) in the 
manner similar to above. 

[0720] The recovery conditions may additionally include kinematics conditions and dynamics conditions, such as 
whether a joint angle exceeds its allowable range, whether there is no interference of leg or the like, whether joint 
angular velocity and torque are excessive, and the like, other than the foregoing conditions. 

35 [0721] Accordingly, when processing of the main flowchart is changed so that current time gait parameters (the 
desired ZMP or landing position and time) are corrected for each control cycle as described earlier, it is also possible 
to add the following as one of the recovery conditions: values of gait parameters, which are changed as appropriate 
to maintain high stability margin of current time gait, shall become appropriate values (shall satisfy a certain constraint), 
[0722] The landing position and landing time determined (read) at switching moment of gait are determined by com- 

40. mands from a host control device (commands from a gait plan determinator, an operator, or the like, hereinafter referred 
to as "original requirements"). Hence, the landing position and landing time of the corrected gait should return to the 
landing position and landing time determined (read) at the switching moment of gait, as much as possible. Therefore, 
the following may be added to the recovery conditions: the landing position and landing time determined (read) at a 
switching moment of gait should be stored and the landing position and landing time of the corrected gait should 

45 coincide with or be as close to the stored landing position and landing time as possible. However, this does not have 
to be added since there is an effect operated due to the foregoing recovery conditions 3 and 4, that the landing position 
and landing time of the corrected gait gradually return to the landing position and landing time determined (read) at 
the switching moment of gait, as much as possible. 

[0723] Moreover, the following may be added to the recovery conditions: the original requirements should be changed 
50 in accordance with changes of situations, and the gait parameters changed as appropriate to maintain high stability 
margin of the gait as described above should coincide with or be as close to gait parameters which satisfy the changed 
requirements as possible. In this case, the foregoing recovery conditions 3 and 4 should be removed. 
[0724] As for a determination method of model's body horizontal position stabilization floor reaction force's moment 
and model's body posture angle stabilization floor reaction force's moment, which satisfy the aforementioned various 
55 recovery conditions, linear programming (simplex method or the like) or a search method for obtaining optimum values 
under constraints can be used, Alternatively, fuzzy inference may be used. 

[0725] Moreover, when changing a landing position, there may be a situation where obstacles in the walking envi- 
ronment should be taken into consideration. In order to be able to deal with such situation, the corrected gait should 
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be determined with additional processing related to the field of artificial intelligence, such as environment recognition 
and determination of actions. 

[0726] The block diagrams before and after the limiting means (limitation processing unit 211 ) in the foregoing third 
to sixth embodiments may be equivalently or approximately transformed as described by the applicant of the present 
application concerned in PCT application (name: control system) filed as of December 26th, 2002, for example. 
[0727] In this case, a value obtained by dividing the model's stabilization moment for correcting body horizontal 
position Mpf by h is passed Lhough a low pass filter and the value thus obtained is subtracted from the corrected desired 
floor reaction force's horizontal component (full-model's floor reaction force's horizontal component Ffuil). The resulting 
value corresponding to the estimated value of bias destm in the above-mentioned PCT application. Therefore, the 
above-mentioned block diagrams may be approximately transformed as shown in Fig. 60, by, for example, replacing 
integration of the gain Kc in the foregoing fourth to sixth embodiments by positive feedback system in which first-order 
lag of time constant 1/Kc is used as a feedback element. In this example, the Mpf calculator 215 in the fourth to sixth 
embodiments is approximately transformed as shown in the drawing. 

[0728] In the foregoing first embodiment, in addition to the configuration described in Japanese Patent Laid-Open 
15 Publication No. Heisei 5-337849 proposed by the applicant of the present application concerned, determined are be- 
haviors of two movement modes having different generation ratios of floor reaction force's horizontal component to 
floor reaction force's moment about the desired ZMP For example, determined are body translation acceleration of 
the body translation movement mode and body posture angular acceleration of the body rotation mode. They are 
determined so that a translational force's horizontal component of a floor reaction force does not exceed allowable 
20 range of floor reaction force's horizontal component. Thus, the gait of the actual robot 1 can be converged to a corrected 
desired gait (gait finally outputted by the gait generating device 100). In other words, the posture of the actual robot 1 
can be stabilized. 

[0729] Further, a difference between desired floor reaction force's moment for compliance control and model manip- 
ulation floor reaction force's moment becomes the total recovering force. 

25 [0730] Moreover, the model manipulation floor reaction force's moment can be any value without consideration of 
the range where ZMP can exist Thus, a very high posture recovering force can be generated. 
[0731] Yet further, the translational force's horizontal component of a floor reaction force does not exceed the allow- 
able range of floor reaction force's horizontal component. Thus, robot 1 can be prevented from slipping. 
[0732] Furthermore, during a period when a floor reaction force's vertical component is zero, that is, a period when 

30 both legs 2 and 2 do not contact the floor, posture is recovered depending on the body rotation movement mode, 
without depending on the body translation mode. Thus, posture is effectively recovered without depending on a frictional 
force between the floor and foot 22. 

[0733] Further, the actual floor reaction force's moment is prevented from being excessively large. Thus ; occurrence 
of problems, such as lowering foot 22's original sense of contact with the floor and raising foot 22's bottom surface, 
35 can be prevented or suppressed. 

[0734] Moreover, current time gait parameters are determined or changed so that a new current time gait, in which 
the end state of the corrected gait for one step is used as a new initial state, becomes gradually close to a normal gait. 
Thus, gait with ensured stability can be generated continuously (for a long period of time). 

[0735] In the foregoing second embodiment, the original gait and corrected gait are simultaneously generated as 
40 described earlier. The corrected gait is corrected for stabilizing the posture of the actual robot 1 . When there remains 
a margin even after the floor reaction force's moment required for posture recovery is generated by compliance control, 
the corrected gait converges to the original gait using the margin as much as possible. Therefore, in addition to the 
operational advantages of the foregoing first embodiment, it is possible to generate a gait close to the initially-set 
original gait, that is, a gait close to the gait conforming to the initial requirements. Thus, when there is a movement 
45 path set in advance, it is possible to prevent a large deviation from the movement path. In addition, convergence of 
the body posture angle of the corrected gait to the body posture angle of the. original gait (initially determined gait) is 
prioritized over convergence of the body horizontal position of the corrected gait to the body horizontal position of the 
original gait (initially determined gait). Thus : large fluctuations of the body posture angle can be suppressed. 
[0736] In the foregoing first to sixth embodiments, the floor reaction force's horizontal component allowable limit is 
set. However, since the floor reaction force's horizontal component and robot's total center of gravity horizontal accel- 
eration are in proportion to each other, there is no problem to use the robot's total center of gravity horizontal acceleration 
and its allowable range in stead of the floor reaction force's horizontal component and its allowable range in each 
embodiment described earlier, It is also no problem to explicitly set parameters related to a horizontal acceleration 
trajectory of a portion with a behavior close to the robot's total center of gravity horizontal acceleration trajectory. For 
55 example, where the masses of the legs 2 and 2 are sufficiently smaller than the mass of the body 24, the body horizontal 
acceleration trajectory and total center of gravity horizontal acceleration trajectory of the robot 1 are almost the same 
or in proportional to each other. Thus, the body horizontal acceleration and its allowable range can be used instead of 
the floor reaction force's horizontal component and its allowable range. 
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[0737] Moreover, for gait generation while the robot 1 is moved on a slope (while the robot- 1 is moved on a inclined 
floor surface), an allowable range of a floor surface parallel component (component parallel to the floor surface) of the 
translation floor reaction force, that is, a allowable range of a friction force, or a allowable range of a floor surface 
parallel component of the total center-of-gravity acceleration (this component, excluding a gravity component, is pro- 
portional to a frictional force) may be set in stead of setting the floor reaction force's horizontal component allowable 
limit and allowable range of total center-of-gravity acceleration horizontal component. For example, description is given 
regarding a case of setting the allowable range of the floor surface parallel component (frictional force) of the translation 
floor reaction force. (This description is the same of a case of setting the allowable range of the floor surface parallel 
component of the total center-of-gravity acceleration). Where an inclination angle relative to the parallel floor surface 
is set as Gf (this inclination angle is setto be a positive value when the slope descends forward in the traveling direction 
of the robot 1), a relation expressed by the following Equation c72 about the frictional force holds true. Therefore, in 
the case of generating a gait to have algorithm similar to those of the foregoing embodiments, the frictional force 
allowable range can be converted into floor reaction force's horizontal component allowable limit by the use of the 
relation of Equation c72 to set the floor reaction force's horizontal component allowable limit. Note that, in this case, a 
desired floor reaction force's vertical component can be used as a floor reaction force's vertical component in Equation 
c72. 

Frictional force = floor reaction force's horizontal component 
*cos(6f) - floor reaction force's vertical component*sin(ef) Equation c72 

[0738] In the foregoing embodiments, two movement modes, the body rotation mode and body translation mode, 
are used in order to allow the floor reaction force's horizontal component and floor reaction force's moment about the 
desired ZMP to be appropriate values. However, movement modes other than above may be used. In this case, one 
of the movement modes does not have to be a movement mode which does not generate a floor reaction force's 
horizontal component. This is because, as long as two movement modes with different generation ratios of floor reaction 
force's horizontal component to floor reaction force's moment about the desired ZMP, are used, any combination of 
modes can generate arbitrary floor reaction force's horizontal component and floor reaction force's moment about the 
desired ZMP like the above example. 

[0739] Further, a movement mode other than those related to body posture may be used. However, it is necessary 
to choose a movement mode which is capable of generating a largest possible floor reaction force's horizontal com- 
ponent or floor reaction force's moment about the desired ZMP by smallest possible displacement. 
[0740] For example, a movement mode for swinging right and left arms around in the same rotation direction, or a 
movement mode which causes a perturbation of a position of foot which does not contact a floor (which is in the air), 
may be used. However, when causing a perturbation of a free leg trajectory, the perturbation amount should be returned 
to substantially zero by the moment immediately before landing so that the landing position does not change. 
[0741] . Furthermore, three or more movement modes may be used. 

[0742] Among the selected modes, at least two modes should have mutually different generation ratios of floor re- 
action force's horizontal component to floor reaction force's moment about the desired ZMP. Otherwise, in general, 
there will be no solutions of simultaneous equations. 

[0743]- Moreover, whenever possible, it is preferred to combine the following movement modes: a movement mode 
which can make a sufficiently large change of a floor reaction force's moment about the desired ZMP without changing 
a floor reaction force's horizontal component so much; and a movement mode which can make a sufficiently large 
change of a floor reaction force's horizontal component without changing a floor reaction force's moment about the 
desired ZM P so much. 

[0744] In other words, it is preferred to combine a movement mode which can make a sufficiently large change of 
an angular momentum without changing total center of gravity so much, and a movement mode which can make a 
sufficiently large change of total center of gravity without changing an angular momentum so much. This is because 
displacement of a movement mode becomes small. 

[0745] Other than the foregoing dynamic models used in the embodiments, the following models may be used as 
the aforementioned simplified model. 

(1) A nonlinear model in which material particles are set in a plurality of links as shown in Fig, 12 (model with 
multiple material particles) 

(2) A model with three material particles shown in Patent Application No. 2000-35201 1 proposed by the applicant 
of the present application concerned. 

(3) A model with one material particle in which only the body has a mass. 
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(4) A model which ignores an inertial force's moment generated by a change of angular momentum about the tota! 
center of gravity. 

(5) A separate type model having separate partial models including: a partial model representing a relation between 
the resultant force of gravity and inertial force (or floor reaction force) and body translation movement; and a partial 

5 model representing a relation between the above resultant force and body rotation movement. For example, the 

material parLicles shown in Fig. 10 are the partial model representing the relation between the above-mentioned 
resultant force and body translation movement, and the flywheel shown in Fig. 1 0 is the partial model representing 
the relation between the above-mentioned resultant force and body rotation movement. 

10 [0746] However, the above models of (2), (3) and (4) cannot be used in the embodiment in which the moment for 
correcting simplified model's body posture angle is added to the simplified model. 

[0747] Note that, it is basically preferred that a dynamic model having higher approximation accuracy than that of 
the simplified model is used as the full model. However, a dynamic model having approximate accuracy equal to that 
of the simplified model may be used. 
15 [0748] Further, in each embodiment described earlier, equivalent modification, such as changing the order of calcu- 
lation processing, can be made in block diagrams, flowcharts, algorithms and the like. A low pass filter may also be 
inserted where appropriate. 

[0749] Each foregoing embodiment has been described with regard to a biped mobile robot. However, the present 
invention can be applied to any robot with one foot as well as any multi-legged robot having three or more feet. 

20 

INDUSTRIAL APPLICABILITY 

[0750] As described so far, the present invention is useful as it can perform movement control of a robot, which 
enables a legged mobile robot such as a biped mobile robot to move smoothly with stable posture without causing slip 
25 or the like. 



Claims 

30 1. A control device for a legged mobile robot that moves by moving legs extending from a body, for successively 
determining an instantaneous value of a desired movement of the legged mobile robot by the use of a dynamic 
model representing at least a relation between a movement and a floor reaction force of the robot, and performing 
movement control of the robot to allow the movement of the robot to follow the determined instantaneous value of 
the desired movement, the control device comprising: 

35 

allowable range setting means for setting a allowable range of a variable to be limited, which is at least a 
horizontal component of a translation floor reaction force or a floor surface parallel component of a translation 
floor reaction force, acting on the robot, or a total center-of-gravity acceleration or a floor surface parallel 
component of the total center-of-gravity acceleration of the robot; and 
40 desired instantaneous value determining means for determining a new instantaneous value of the desired 

movement based on at least an error between a desired state quantity of a posture of the robot, which corre- 
sponds to the determined instantaneous value of the desired movement, and an actual state quantity of the 
posture of the robot such that the variable to be limited which is defined based on the dynamic model in 
accordance with the new instantaneous value, remains within the allowable range. 

45 

* 

2. The control device for a legged mobile robot according to claim 1, wherein a movement of the dynamic model 
includes at least a plurality of movement modes of the robot, the movement modes having mutually different gen- 
eration ratios of a floor reaction force's moment to the translation floor reaction force, and the desired instantaneous 
value determining means determines the new instantaneous value of the desired movement by adjusting a plurality 

50 of the movement modes of the movement of the dynamic model in accordance with at least the allowable range. 

3. The control device for a legged mobile robot according to claim 2, wherein the movement modes include a posture 
changing movement for changing a posture of a predetermined portion of the robot while maintaining center-of- 
gravity of the robot almost invariable, and a translation movement of the body of the robot. 

55 

4. The control device for a legged mobile robot according to claim 1 , comprising means for correcting gait parameters 
for determining a pattern (s) of a desired floor reaction force and/or the desired movement of the robot after current 
time, in accordance with at least a state quantity of the dynamic model. 
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5. The control device for a legged mobile robot according to claim 1 , comprising means for successively determining 
a reference instantaneous value of a desired fioor reaction force of the robot, wherein the desired instantaneous 
value determining means determines a correction manipulated variable of the desired floor reaction force in ac- 
cordance with at least the error and the allowable range of the variable to be limited, and also determines the new 

5 instantaneous value of the desired movement to permit a resultant force of an inertial force and gravity, generated 

on the dynamic mode) by the new instantaneous value of the desired movement, lo balance with a floor reacLion 
force obtainedby correcting the reference instantaneous value by the correction manipulated variable. 

6. The control device for a legged mobile robot according to claim 5, wherein a movement of the dynamic model 
10 includes at least a plurality of movement modes of the robot, the movement modes having mutually different gen- 
eration ratios of a floor reaction force's moment to the translation floor reaction force, and the desired instantaneous 
value determining means determines the new instantaneous value of the desired movement by adjusting a plurality 
of the movement modes of the movement of the dynamic model in accordance with at least the allowable range. 

15 7. The control device for a legged mobile robot according to claim 6, wherein the movement modes include a posture 
changing movement for changing a posture of a predetermined portion of the robot while maintaining center-of- 
gravity of the robot almost invariable, and a translation movement of the body of the robot. 

8. The control device for a legged mobile robot according to claim 7, wherein the desired instantaneous value deter- 
20 mining means determines a new desired instantaneous value of the desired movement by preferentially adjusting 

the translation movement of the body, rather than the posture changing movement, in order to permit the resultant 
force to balance with the floor reaction force obtained by correcting the reference instantaneous value by the 
correction manipulated variable of the desired floor reaction force. 

25 9. The control device for a legged mobile robot according to claim 5, comprising means for determining the correction 
manipulated variable of the desired floor reaction force in accordance with at least the error, the allowable range 
of the variable to be limited, and a state quantity of the dynamic model. 

10. The control device for a legged mobile robot according to claim 5, comprising means for correcting gait parameters 
30 for determining a pattern (s) of the desired floor reaction force and/or the desired movement of the robot after 

current time, in accordance with the correction manipulated variable of the desired floor reaction force used for 
determining an instantaneous value of the desired movement, and/or a change of a state quantity of the dynamic 
model by the correction manipulated variable. 

35 11 . The control device for a legged mobile robot according to claim 5, comprising: first means for determining a first 
required manipulated variable of a floor reaction force in accordance with the error so that the error becomes close 
to zero; second means for determining an actual floor reaction force manipulated variable and the correction ma- 
nipulated variable of the desired floor reaction force, which define a desired value of an actual floor reaction force 
of the robot, based on at least the first required manipulated variable; and third means for performing movement 

^o control of the robot in accordance with the actual floor reaction force manipulated variable and the instantaneous 

value of the desired movement. 

12. The control device for a legged mobile robot according to claim 11 , wherein any one of the first required manipulated 
variable, the actual floor reaction force manipulated variable, and the correction manipulated variable of the desired 

45 floor reaction force is a manipulated variable related to a floor reaction force's moment about a point of action of 

a floor reaction force, a position of the point of action of the floor reaction force, or a ZMR 

r 

13. The control device for a legged mobile robot according to claim 11 or 12, wherein the second means determines 
the actual floor reaction force manipulated variable and the correction manipulated variable of the desired floor 

50 reaction force so that a difference between the actual floor reaction force manipulated variable and the correction 

manipulated variable of the desired floor reaction force monotonously changes as the first required manipulated 
variable increases. 

14. The control device for a legged mobile robot according to claim 11 , wherein the second means determines the 
55 actual floor reaction force manipulated variable so that a value obtained by adding the actual fioor reaction force 

manipulated variable to the reference instantaneous value remains within a predetermined actual floor reaction 
force allowable range. 
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15. The control device for a legged mobile robot according to claim 14, wherein, when a value obtained by adding the 
first required manipulated variable to the reference instantaneous value is a value within the predetermined actual 
floor reaction force allowable range, the second means determines the first required manipulated variable as the 
actual floor reaction force manipulated variable, and determines the correction manipulated variable of the desired 

5 floor reaction force to be almost zero or a value defined In accordance with the state quantity of the dynamic model, 

and, when the value oblained by adding the First required manipulated variable to the reference instantaneous 
value deviates from the predetermined actual floor reaction force allowable range, the second means determines 
a value obtained by subtracting the reference instantaneous value from a limit value of the actual floor reaction 
force allowable range, as the actual floor reaction force manipulated variable, and determines the correction ma- 

10 nipulated variable of the desired floor reaction force in accordance with at least a difference between the actual 

floor reaction force manipulated variable and the first required manipulated variable. 

16. The control device for a legged mobile robot according to claim 14, wherein the second means comprises: means 
for obtaining provisionally determined values of the actual floor reaction force manipulated variable and the cor- 

15 rection manipulated variable of the desired floor reaction force so that a difference between the actual floor reaction 

force manipulated variable and the correction manipulated variable of the desired floor reaction force becomes at 
least a value corresponding to the first required manipulated variable; means for obtaining an estimated value of 
the variable to be limited corresponding to the new instantaneous value of the desired movement when the new 
instantaneous value of the desired movement is assumed to be determined by the use of the obtained provisionally 

20 determined value of the correction manipulated variable of the desired floor reaction force; means for comparing 

a value obtained by adding the provisionally determined value of the actual floor reaction force manipulated variable 
to the reference instantaneous value and the estimated value of the variable to be limited, to the predetermined 
actual floor reaction force allowable range and the allowable range of the variable to be limited, respectively, and 
determining a group of the actual floor reaction force manipulated variable and the variable to be limited which 

25 satisfy limits by the actual floor reaction force allowable range and the allowable range of the variable to be limited, 

respectively, based on a result of the comparison; and means for determining the correction manipulated variable 
of the desired floor reaction force based on the variable to be limited and a value obtained by subtracting the first 
required manipulated variable from the determined actual floor reaction force manipulated variable. 

30 17. The control device for a legged mobile robot according to claim 16, wherein a movement of the dynamic model 
includes at least a plurality of movement modes having mutually different generation ratios of a floor reaction force's 
moment to a translation floor reaction force, and the correction manipulated variable of the desired floor reaction 
force is configured by a plurality of manipulated variables, each corresponds to each of the movement modes. 

35 18. The control device for a legged mobile robot according to claim 11 , comprising fourth means for determining a 
second required manipulated variable of the floor reaction force to permit a state quantity of the dynamic model 
to be close to a predetermined state quantity in accordance with the state quantity of the dynamic model, wherein 
the second means determines the actual floor reaction force manipulated variable and the correction manipulated 
variable of the desired floor reaction force based on at least the first required manipulated variable, the second 

40 required manipulated variable, and the allowable range. 

19. The control device for a legged mobile robot according to claim 1 8, wherein any one of the first and second required 
manipulated variables, the actual floor reaction force manipulated variable and the correction manipulated variable 
of the desired floor reaction force is a manipulated variable related to a floor reaction force's moment about a point 

45 of action of a floor reaction force, a position of the point of action of the floor reaction force, or a ZMP. 

20. The control device for a legged mobile robot according to claim 1 8 or 19, wherein the second means determines 
the actual floor reaction force manipulated variable and the correction manipulated variable of the desired floor 
reaction force so that a difference between the actual floor reaction force manipulated variable and the correction 

50 manipulated variable of the desired floor reaction force monotonously changes as the first required manipulated 

variable increases. 

21. The control device for a legged mobile robot according to claim 18, wherein the second means determines the 
actual floor reaction force manipulated variable so that a value obtained by adding the actual floor reaction force 

55 manipulated variable to the reference instantaneous value remains within a predetermined actual floor reaction 

force allowable range. 

22. The control device for a legged mobile robot according to claim 21 , wherein the second means comprises: means 
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for obtaining provisionally determined values of the actual floor reaction force manipulated variable and the cor- 
rection manipulated variable of the desired floor reaction force so that a difference between the actual floor reaction 
force manipulated variable and the correction manipulated variable of the desired floor reaction force becomes at 
least a value corresponding to the first required manipulated variable and that the correction manipulated variable 
of the desired floor reaction force becomes a value corresponding to the second required manipulated variable; 
means for obtaining an estimated value of the variable to be limited corresponding to the new instantaneous value 
of the desired movement when the new instantaneous value of the desired movement is assumed to be determined 
by the use of the obtained provisionally determined value of the correction manipulated variable of the desired 
floor reaction force; means for comparing a value obtained by adding the obtained provisionally determined value 
of the actual floor reaction force manipulated variable to the reference instantaneous value and the estimated 
value of the variable to be limited, to the predetermined actual floor reaction force allowable range and the allowable 
range of the variable to be limited, respectively, and determining a group of the actual floor reaction force manip- 
ulated variable and the variable to be limited which satisfy limits by the actual floor reaction force allowable range 
and the allowable range of the variable to be limited, respectively, based on a result of the comparison; and means 
for determining the correction manipulated variable of the desired floor reaction force based on the variable to be 
limited and a value obtained by subtracting the first required manipulated variable from the determined actual floor 
reaction force manipulated variable. 

23. The control device for a legged mobile robot according to claim 22, wherein a movement of the dynamic model 
includes at least a plurality of movement modes having mutually different generation ratios of a floor reaction force's 
moment to a translation floor reaction force, and the correction manipulated variable of the desired floor reaction 
force is configured by a plurality of manipulated variables, each corresponds to each of the movement modes. 
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FIG.5 

( RUNNING GAIT ) 
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FIG.6 

( DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT ) 
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FIG.8 

( BODY TRANSLATION MODE ) 
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FIG.9 

( BODY ROTATION MODE ) 
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FIG.10 

( SIMPLIFIED MODEL WITH FLYWHEEL ) 
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FIG.14 

( PROCESS OF DETERMINING NORMAL GAIT PARAMETER ) 
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FIG.15 

(RELATIONSHIP AMONG FOOT LANDING POSITIONS/POSTURES FOR NORMAL GAIT) 
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FIG.16 

(DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT ) 
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FIG.l 8 

( DESIRED ZMP) 
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FI6.1 9 

{ PROCESS OF SEARCHING INITIAL DIVERGENCE COMPONENT FOR NORMAL GAIT ) 
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BOUNDARY REQUIREMENT ERROR (errx, errv) = (Xs, Vxs) - (Xe, Vxe) 



S212 



S214 YES 



errx AND errv FALL WITHIN ALLOWABLE RANGES? 



f EXIT REPETITION LOOPj 



DETERMINE A PLURALITY OF INITIAL VALUE CANDIDATES (Xs+ A Xs, Vxs), 
(Xs, Vxs+ A Vxs) IN THE VICINITY OF (Xs, Vs) AND OBTAIN 
BOUNDARY REQUIREMENT ERRORS THEREFORE ON THE ASSUMPTION THAU 
THE CANDIDATES ARE INITIAL STATES OF BODY 



S216 



S218 



DETERMINE NEXT INITIAL VALUE CANDIDATE (Xs, Vxs) BASED ON BOUNDARY REQUIREMENT 
ERRORS FOR (Xs. Vxs) AND INITIAL VALUE CANDIDATES IN THE VICINITY OF (Xs. Vxs) 



DETERMINE INITIAL BODY HORIZONTAL POSITION/VELOCITY (XO, VO), INITIAL 
BODY VERTICAL POSITION/VELOCITY (ZO, VzO) AND INITIAL BODY POSTURE 
ANGLE AND ANGULAR VELOCITY AT ORIGINAL INITIAL TIME 0 



S220 



DETERMINE NORMAL TURNING GAIT'S INITIAL DIVERGENCE COMPO- 
NENT q[0] USING FORMULA: q[Q] = XO + VO/co 0 



S222 



DETERMINE VALUE q", WHICH IS NORMAL TURNING GAIT'S INITIAL DIVERGENCE 
COMPONENT q[0] SEEN FROM CURRENT TIME GAIT'S SUPPORTING LEG COORDINATE 
SYSTEM, AND VALUE (ZO", VzO"), WHICH IS INITIAL BODY VERTICAL POSITION/VELOCITY 
SEEN FROM CURRENT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM 
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FIG.20 

( PROVISIONAL GAIT GENERATION PROCESS FOR NORMAL GAIT) 
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S300 



INITIALIZE 

PROVISIONAL GAIT GENERATION TIME k = Ts 

(Ts: INITIAL TIME OF NORMAL GAIT'S CALCULATION) 

BODY HORIZONTAL POSITIONAELOCITY = {Xs, Vxs) 

BODY VERTICAL POSITION/VELOCITY = (Zs, Vzs) 

BODY POSTURE ANGLE = INITIAL VALUE OF REFERENCE BODY POSTURE ANGLE 

BODY POSTURE ANGULAR VELOCITY 

= INITIAL VALUE OF REFERENCE BODY POSTURE ANGULAR VELOCITY 



S302 



S306 




S304 YES 


NORMAL GAIT INSTANTANEOUS VALUE 
DETERMINATION SUBROUTINE 


k ^ Ts + Tcyc? <^ 






k=k + Ak ™» 



DETERMINE INITIAL BODY POSTURE ANGLE AND INITIAL BODY 
ANGULAR VELOCITY FOR NORMAL GAIT 
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FIG.21 

( PROCESS OF DETERMINING NORMAL GAIT INSTANTANEOUS VALUE) 



C ENTRY ) 



DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME k BASED ON GAIT PARAMETER 



$400 



DETERMINE DESIRED ZMP AT TIME k BASED ON GAIT PARAMETER 



S402 



S404 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURE AT TIME k BASED ON GAIT PARAMETER 



S406 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION/VELOCITY THAT 
SATISFIES DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



CALCULATE BODY VERTICAL POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 



S40B 



S410 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmox] AT TIME k BASED ON GAIT PARAMETER 



S412 



DETERMINE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION SO AS TO SATISFY DESIRED ZMP IN SUCH A MANNER THAT FLOOR 
REACTION FORCE'S HORIZONTAL COMPONENT Fx DOESN'T EXCEED [Fxmin, Fxmox] 
AND INITIAL AND FINAL BODY POSTURE ANGULAR VELOCITIES AGREE WITH EACH OTHER 



CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION AND INTEGRATES THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE 
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FIG.22 

( PROCESS OF DETERMINING BODY HORIZONTAL ACCELERATION 
AND BODY POSTURE ANGULAR ACCELERATION FOR NORMAL GAIT ) 

C ENTRY ^ 



SET TIMES Tm, Ts2 AND Tm2 
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S504 



k LIES BETWEEN 
Ts AND Tm OR 
BETWEEN 
Ts2 AND Tm2 ? 
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S502 YES 



INO 



DETERMINE BODY HORIZONTAL ACCELERATION <* tmp THAT IS 
REQUIRED TO SATISFY CURRENT TIME (TIME k] DESIRED ZMP 
IN THE CASE WHERE ROBOT MOVES IN BODY TRANSLATION MODE 



S506 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
Fxtmp IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS a tmp 



S510 



S508 Fxtmp > Fxmax 



Fxtmp ? 




Fxtmp < Fxmin 



DETERMINE HORIZONTAL COMPONENT Fx 
OF FLOOR REACTION FORCE USING FORMULA: 
Fx = Fxmox 



Fx = Fxmin 



S512 



ELSE 



• I Fx = Fxtmp p i 4 



S516 



DETERMINE BODY HORIZONTAL ACCELERATION a OF BODY 
TRANSLATION MODE AND BODY ANGULAR ACCELERATION p 
OF BODY ROTATION MODE USING FORMULAS: 
a = a tmp + (Fx - Fxtmp)/ A Fp 
j8 = (atmp - a)*AMp/AMr 



SET BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PATTERN 



S518 



S520 



CALCULATE INSTANTANEOUS VALUE ZMPrec OF BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN AT TIME k 



$ =-ZMPrec*Fz(k}/AMr 



S522 



S524 



DETERMINE BODY HORIZONTAL ACCELERATION « tmp THAT IS 
REQUIRED TO SATISFY CURRENT TIME (TIME Ic) DESIRED ZMP IN THE 
CASE WHERE ROBOT MOVES ONLY IN BODY TRANSLATION MODE 



a = atmp -(AMr/AMp)*j3 
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S528 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS a 
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FI6.23 

FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 

DETERMINED WITHOUT TAKING ALLOWABLE RANGE INTO CONSIDERATION 



ALLOWABLE RANGE 



Fxtmp 
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FLOATING 
PERIOD 




FLOATING 
PERIOD 
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Tm2 



FIG.24 

FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
DETERMINED TAKING FLOOR REACTION FORCE'S HORIZONTAL 
COMPONENT ALLOWABLE LIMIT INTO CONSIDERATION Fx 



ALLOWABLE RANGE 
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PERIOD 
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FIG.25 

BODY INCLINATION ANGULAR ACCELERATION fi 
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FLOATING 
PERIOD 



FLOATING 
PERIOD 
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FIG.26 

BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE 
(ZMPrec) 



0 



Ts 



FLOATING 
PERIOD 




FLOATING 
PERIOD 



FIG.27 

BODY INCLINATION ANGULAR ACCELERATION $ 

(FOR RETURNING BODY INCLINATION VELOCITY TO INITIAL VALUE) 
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FLOATING 
PERIOD 



FLOATING 
PERIOD 



FIG.28 

FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
DETERMINED TAKING FLOOR REACTION FORCE'S HORIZONTAL 
COMPONENT ALLOWABLE RANGE INTO CONSIDERATION 



ALLOWABLE RANGE 
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FLOATING Tm 
PERIOD 
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FLOATING 
PERIOD 
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FIG.29 



FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
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ALLOWABLE RANGE 




FLOATING 
PERIOD 



Tm 



FLOATING 
PERIOD 



FIG.30 

BODY INCLINATION ANGULAR ACCELERATION $ 
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FLOATING 
PERIOD 



FLOATING 
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FIG.31 

( RELATIONSHIP AMONG BODY POSITIONS 
AT THE TIME OF LANDING FOR NORMAL GAIT PARAMETER ) 



NEXT TIME GAIT'S 
SUPPORTING LEG 
COORDINATE SYSTEM 




CURRENT TIME 
SUPPORTING LEG 
COORDINATE SYSTEM 



NEXT BUT ONE TIME GAIT'S 
SUPPORTING LEG 
COORDINATE SYSTEM 



BODY TRAJECTORY FOR NORMAL GAIT 

{FIRST TURNING GAIT + SECOND TURNING GAIT) 
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FIG.32 

{ PROCESS OF PROVISIONALLY DETERMINING CURRENT TIME GAIT PARAMETER ) 
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DETERMINE FOOT TRAJECTORY PARAMETER 
FOR CURRENT TIME GAIT 



S60O 



DETERMINE REFERENCE BODY POSTURE 
TRAJECTORY PARAMETER FOR CURRENT TIME GAIT 



S602 



DETERMINE ARM POSTURE TRAJECTORY 
PARAMETER FOR CURRENT TIME GAIT 



S604 



DETERMINE FLOOR REACTION FORCE'S VERTICAL COMPONENT 
TRAJECTORY PARAMETER FOR CURRENT TIME GAIT 



S606 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmax] FOR CURRENT TIME GAIT 



S608 



PROVISIONALLY DETERMINE ZMP TRAJECTORY 
PARAMETER FOR CURRENT TIME GAIT 



S610 



SET BODY INCLINATION ANGLE 
RESTORING PERIOD [Ta, Tb] 
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FIG.33 

( FLOOR REACTION FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE ) 



LOWER LIMIT VALUE Fxmin AND UPPER LIMIT VALUE Fxmax 

OF FLOOR REACTION FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE 




ONE-LEG SUPPORTING PERIOD 



FLOATING 
PERIOD 



119 



BNSDOCID: <EP 1475198A1 I > 



EP 1 475 198 A1 



FIG.34 

(PROCESS OF CORRECTING CURRENT TIME GAIT PARAMETER IN SEARCHING MANNER) 
C ENTRY _ ) 



S702 



CALCULATE PROVISIONAL CURRENT TIME GAIT TO END TIME BASED ON PROVISIONAL 
DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS 



S700 




S704 



DETERMINE FINAL DIVERGENCE COMPONENT qO[k] FROM BODY POSITION/VELOCITY 

{Xe, Ve) AT THE END OF CURRENT TIME GAIT USING FORMULA: 

qO[k j = Xe + Vxe / co 0 



DETERMINE FINAL DIVERGENCE COMPONENT ERROR errq USING FORMULA: 
errq = qO[k] - q" 



S706 



S708 YES 



errq FALLS WITHIN ALLOWABLE RANGE? < 



{ EXIT REPETITION LOOP) 



S710 



CALCULATE PROVISIONAL CURRENT TIME GAIT TO END TIME BASED ON DESIRED 
ZMP OBTAINED BY CORRECTING PROVISIONAL DESIRED ZMP ACCORDING TO 
RELATIONSHIP SHOWN IN FIGURE 38 ON THE ASSUMPTION THAT a = A a 



BASED ON BODY POSITION/VELOCITY (Xel, Vxel ) AT THE END OF CURRENT 
TIME GAIT WHICH IS RECALCULATED BASED ON CORRECTED DESIRED ZMP, 
DETERMINE FINAL DIVERGENCE COMPONENT ql [k] USING FORMULA: 
ql[k] = Xel + Vxel AoO 



S712 



DETERMINE PARAMETER SENSITIVITY r USING FORMULA: 
r-(ql[k]-qO[k])/Ao 



S714 



S716 



ADD CORRECTION QUANTITY DETERMINED ON THE ASSUMPTION OF a = -errq/r 
TO PROVISIONAL DESIRED ZMP TO RENEW PROVISIONAL DESIRED ZMP 



S718 



— 



DETERMINE BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN 
BASED ON DIFFERENCE BETWEEN FINAL BODY POSTURE ANGLE FOR PROVISIONAL 
CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGLE FOR NORMAL GAIT AND 
DIFFERENCE BETWEEN FINAL BODY POSTURE ANGULAR VELOCITY FOR PROVISIONAL CURRENT 
TIME GAIT AND INITIAL BODY POSTURE ANGULAR VELOCITY FOR NORMAL GAIT 



DETERMINE, AS DESIRED ZMP PATTERN, PATTERN OBTAINED BY ADDING 
BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PATTERN TO PROVISIONAL DESIRED ZMP PATTERN 
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FIG.35 

( PROCESS OF GENERATING PROVISIONAL CURRENT TIME GAIT ) 
C ENTRY ) 



INITIALIZE 

PROVISIONAL GAIT GENERATION TIME k=0 
VALUES IN CURRENT TIME SUPPORTING LEG COORDINATE SYSTEM 
CONVERTED FROM FINAL STATE OF LAST TIME DESIRED GAIT IS USED 
AS INITIAL STATES OF CURRENT TIME GAIT 
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S8G4 YES 


CURRENT TIME GAIT INSTANTANEOUS 
VALUE DETERMINATION SUBROUTINE 


k < Tcurrs ? 






kek + Ak S808 
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FIG.36 

( PROCESS OF DETERMINING CURRENT TIME PROVISIONAL GAIT INSTANTANEOUS VALUE ) 



( ENTRY ) 



DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME k BASED ON GAIT PARAMETER 



S900 



DETERMINE DESIRED ZMP AT TIME k BASED ON GAIT PARAMETER 



S902 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURE AT TIME k BASED ON GAIT PARAMETER 



S904 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION THAT SATISFIES 
DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



S906 



CALCULATE BODY VERTICAL POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 



S908 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmax] AT TIME k BASED ON GAIT PARAMETER 

._ ._ . .._ _ . _ - . . - - • — - ^ . : . - _ - 



S910 



DETERMINE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION FOR CURRENT TIME PROVISIONAL GAIT SO AS TO SATISFY DESIRED 
ZMP IN SUCH A MANNER THAT FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
Fx DOESN'T EXCEED [Fxmin, Fxmax] 



S< 



CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION AND INTEGRATES THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE ANGLE 
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FIG. 37 

{ PROCESS OF DETERMINING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION FOR PROVISIONAL CURRENT TIME GAIT) 
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RESTORING 
PERIOD 
[To, Tb]? 



C RETURN 3 



DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS REQUIRED 
TO SATISFY DESIRED ZMP AT PRESENT TIME (TIME k) IF ROBOT IS CAUSED 
TO PERFORM MOVEMENT OF BODY TRANSLATION MODE 



lYES 



SI 004 



OBTAIN ROOR REACTION FORCE'S HORIZONTAL COMPONENT Fxtmp 
WHERE BODY HORIZONTAL ACCELERATION IS a tmp 



SI 008 



SI 006 Fxtmp > Fxmax 



Fxtmp ? 




Fxlmp < Fxmin 



DETERMINE FLOOR REACTION FORCE'S 
HORIZONTAL COMPONENT Fx BY THE 
FOLLOWING EQUATIONS Fx = Fxmax 



Fx = Fxmin 



ELSE 



Fx = Fxtmp 



SI 010 
SI 01 2 



S1014 



DETERMINE BODY HORIZONTAL ACCELERATION a OF BODY 
TRANSLATION MODE AND BODY ANGULAR ACCELERATION 
$ OF BODY ROTATION MODE BY THE FOLLOWING EQUATIONS 

a = a tmp + (Fx - Fxtmp)/ A Fp 
8 - ( a tm p - a ) * A Mp/ A Mr 



SET PATTERN OF ZMP-CQNVERTED VALUE OF 
BODY INCLINATION RESTORING MOMENT 



$1016 



SI 01 8 



CALCULATE INSTANTANEOUS VALUE OF PATTERN OF ZMP-CONVERTED 
VALUE OF BODY INCLINATION RESTORING MOMENT ZMPrec AT TIME k 



p =-ZMPrec*Fz{k)/AMr 



SI 020 



SI 022 



OBTAIN HORIZONTAL BODY ACCELERATION a tmp REQUIRED TO 
SATISFY DESIRED ZMP AT PRESENT TIME (TIME k) IF ROBOT IS 
CAUSED TO PERFORM MOTION IN BODY TRANSLATION MODE ONLY 



a = glmp-tAMr/AMp)*/? I s1024 



SI 026 



OBTAIN FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
WHEN HORIZONTAL BODY ACCELERATION IS a 
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FIG.38 

( CORRECTION OF DESIRED ZMP) 

PROVISIONAL DESIRED ZMP 

X 

FREE LEG'S HEEL POSITION 4 
AT THE END OF GAIT 

SUPPORTING LEG'S 
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SUPPORTING LEG'S 
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FIG.39 

( SUPPORT POLYGON AND ZMP ALLOWABLE RANGE) 



Y(LEFT) 

A 



ZMP ALLOWABLE RANGE 

(FLOOR REACTION FORCE CENTRAL POINT ALLOWABLE RANGE) 

LEFT FOOT 




RIGHT FOOT 
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FIG.40 

(PROCESS OF DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE) 



C ENTRY ) 



DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME t BASED ON GAIT PARAMETER 



SI 000 



DETERMINE DESIRED ZMP AT TIME k BASED ON GAIT PARAMETER 



S1002 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURES AT TIME t BASED ON GAIT PARAMETER 



SI 004 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION SATISFYING 
DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



SI 006 



CALCULATE BODY VERTICAL POSITION SATISFYING 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 



SI 008 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmax] AT TIME t BASED ON GAIT PARAMETER 



S1010 



DETERMINE FLOOR REACTION FORCE'S MOMENT ALLOWABLE RANGE 
AT TIME t BASED ON GAIT PARAMETER 



SI Oil 



S1012 



DETERMINE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION OF CURRENT TIME GAIT SO THAT MODEL MANIPULATION FLOOR REACTION 
FORCE'S MOMENT IS GENERATED ABOUT DESIRED ZMP AND THAT FLOOR REACTION 
FORCE'S HORIZONTAL COMPONENT Fx DOES NOT EXCEED [Fxmin, Fxmax] 



CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION, AND INTEGRATE THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE ANGLE 
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FI6.41 

( PROCESS OF DETERMINING BODY HORIZONTAL ACCELERATION/BODY 
POSTURE ANGULAR ACCELERATION OF CURRENT TIME GAIT ) 

ENTRY 3 



CURRENT TIME t 
FALLS WITHIN 
BODY 

INCLINATION 
ANGLE 
RESTORING 
PERIOD 
[Ta, Tb]? 



C RETURN ") 



SI 102 



SHOO NO 



— 



DETERMINE BODY HORIZONTAL ACCELERATION atmp REQUIRED 
TO GENERATE MODEL MANIPULATION FLOOR REACTION FORCE'S 
MOMENT ABOUT PRESENT DESIRED ZMP (AT TIME 1) IN THE CASE 
WHERE ROBOT MOVES IN BODY TRANSLATION MODE 



S1104 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fxtmp 
IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS a imp 



SI 108 



SI 106 Fxtmp > Fxmax 



Fxtmp 




Fxtmp < Fxmin 



DETERMINE FLOOR REACTION FORCE'S 
HORIZONTAL COMPONENT Fx 
WITH FORMULA: Fx = Fxmax 



Fx = Fxmin 



ELSE 



Fx = Fxtmp 



SI 110 

sn 12 



SUM 



DETERMINE BODY HORIZONTAL ACCELERATION a OF BODY 
TRANSLATION MODE AND BODY ANGULAR ACCELERATION & 
OF BODY ROTATION MODE WITH FORMULAS: 
a = a tmp + (Fx - Fxtmp)/ A Fp 
/S = ( atmp -a)*AMp/AMr 



YES 



SET BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE PATTERN 



sn 16 



S1U8 



CALCULATE INSTANTANEOUS VALUE OF BODY INCLINATION RESTORING 
MOMENT ZMP-CONVERTED VALUE PATTERN ZMPret AT TIME t 



B =-ZMPrec*Fz(k)/AMr 



SI 120 



SI 122 



DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS 
REQUIRED TO GENERATE MODEL MANIPULATION FLOOR REACTION 
FORCE'S MOMENT ABOUT PRESENT DESIRED ZMP (AT TIME t) IN THE 
CASE WHERE ROBOT MOVES IN BODY TRANSLATION MODE 



a = otmp-(AMr/AMp)*/3 



SI 124 
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DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
WHEN BODY HORIZONTAL ACCELERATION IS a 
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FIG.42 

( DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT WHEN WALKING ) 
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C START ) 




C 



INITIALIZE ( t =0 OR THE LIKE ) 



FIG 44 

{ FLOWCHART OF GAIT GENERATION PROCESSING } 
S2010 



WAIT FOR TIMER INTERRUPTION ( FOR EACH CONTROL CYCLE) 



S2G14 



S2016 YES 



S2012 



GAIT 

TRANSITION? 




t=0 



S2018 



S2020 



READ NEXT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, NEXT 
BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, CURRENT 
TIME GAIT'S PERIOD, AND NEXT TIME GAIT'S PERIOD 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S2022 



S2024 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENCE COMPONENT, INITIAL BODY POSITION/VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY} 



S2026 



PROVISIONALLY DETERMINE GAIT PARAMETER FOR CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



S2028 



SUBROUTINE FOR CORRECTING CURRENT TIME GAITS PARAMETER 
(CORRECT CURRENT TIME GAIT PARAMETERS IN SUCH A MANNER THAT 
FINAL DIVERGENCE COMPONENT FOR CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENCE COMPONENT FOR NORMAL TURNING GAIT) 



DETERMINE PARAMETERS OF FLOOR REACTION 
FORCE'S MOMENT ALLOWABLE RANGE 
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SUBROUTINE FOR DETERMINING ORIGINAL GAIT'S INSTANTANEOUS VALUE 
(DETERMINE ORIGINAL GAIT'S INSTANTANEOUS VALUES IN SUCH A MANNER THAT 
FLOOR REACTION FORCE'S MOMENT ABOUT DESIRED ZMP BECOMES ZERO) 



$2030 



SUBROUTINE FOR DETERMINING CORRECTED GAIT'S INSTANTANEOUS VALUE 
(WHILE CORRECTING DESIRED ZMP TO BE CLOSE TO ORIGINAL GAIT, DETERMINE 
CORRECTED GAIT'S INSTANTANEOUS VALUES TO GENERATE MODEL MANIPULATION 
FLOOR REACTION FORCE'S MOMENT ABOUT CORRECTED DESIRED ZMP) 
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DETERMINE ARM SWINGING MOVEMENT FOR CANCELING SPIN FORCE 
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FIG.45 

[ PROCESS OF DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE ) 
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DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME t BASED ON GAIT PARAMETER 



S2100 



DETERMINE DESIRED ZMP AT TIME 1 BASED ON GAIT PARAMETER 



52102 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURES AT TIME t BASED ON GAIT PARAMETER 



S2104 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION THAT SATISFIES 
DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



S2106 



CALCULATE BODY VERTICAL POSITION SATISFYING 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 
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DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmax] AT TIME t BASED ON GAIT PARAMETER 
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DETERMINE FLOOR REACTION FORCE'S MOMENT ALLOWABLE RANGE AT 
TIME t BASED ON GAIT PARAMETER 



S21U 



DETERMINE MODEL MANIPULATION FLOOR REACTION FORCE'S MOMENT, DESIRED 
FLOOR REACTION FORCE'S MOMENT FOR COMPLIANCE CONTROL, BODY HORIZONTAL] 
ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO SATISFY 
CONDITIONS OF FLOOR REACTION FORCE'S MOMENT ALLOWABLE RANGE AND FLOORj 
REACTION FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE 



S2112 



CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGUIAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION, AND INTEGRATE THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE ANGLE 
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FIG.46 

( PROCESS OF DETERMINING BODY HORIZONTAL 
ACCELERATION/BODY POSTURE ANGULAR ACCELERATION ) 
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DETERMINE MODEL-TO-MODEL BODY HORIZONTAL POSITION DIFFERENCE 
WHICH IS DIFFERENCE BETWEEN BODY HORIZONTAL POSITION OF 
CORRECTED GAIT AND BODY HORIZONTAL POSITION OF ORIGINAL GAIT 



S2200 



DETERMINE MODEL-TO-MODEL BODY POSTURE ANGLE DIFFERENCE 
WHICH IS DIFFERENCE BETWEEN BODY POSTURE ANGLE OF CORRECTED 
GAIT AND BODY POSTURE ANGLE OF ORIGINAL GAIT 



S2202 



BASED ON MODEL-TO-MODEL BODY HORIZONTAL POSITION DIFFERENCE, 
DETERMINE REQUIRED VALUE OF MODEL'S BODY HORIZONTAL POSITION 
STABILIZATION FLOOR REACTION FORCE'S MOMENT REQUIRED TO 
CONVERGE THE DIFFERENCE TO ZERO 
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BASED ON MODEL-TO-MODEL BODY POSTURE ANGLE DIFFERENCE, 
DETERMINE REQUIRED VALUE OF MODEL'S BODY POSTURE ANGLE 
STABILIZATION FLOOR REACTION FORCE'S MOMENT REQUIRED TO 
CONVERGE THE DIFFERENCE TO ZERO 
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S2208 



DETERMINE MODEL'S BODY HORIZONTAL POSITION STABILIZATION MOMENT 
AND MODEL'S BODY POSTURE ANGLE STABILIZATION MOMENT TO SATISFY 
RESTORING CONDITIONS, AND FURTHER DETERMINE BODY HORIZONTAL 
ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION 



MODEL MANIPULATION FLOOR REACTION FORCE'S MOMENT 
= MODEL'S BODY HORIZONTAL POSITION STABILIZATION MOMENT 
+ MODEL'S BODY POSTURE ANGLE STABILIZATION MOMENT 



S2210 



DESIRED FLOOR REACTION FORCE'S MOMENT FOR COMPLIANCE CONTROL 
= COMPENSATING TOTAL FLOOR REACTION FORCE'S MOMENT Mdmd 
+ MODEL MANIPULATION FLOOR REACTION FORCE'S MOMENT 



S2212 



C RETURN ) 



132 





101 BLOCK Oil Of 








on 





EP 1 475 198 A1 



( START _ ) 



INITIALIZE { t =0 OR THE LIKE } 



FIG.48 

( FLOWCHART OF GAIT GENERATION PROCESSING ) 
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WAIT FOR TIMER INTERRUPTION ( EACH CONTROL CYCLE) 
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GAIT 

TRANSITION? 




READ NEXT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT'S PERIOD, AND NEXT TIME GAIT'S PERIOD 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS FOR NORMAL GAIT 
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SUBROUTINE FOR DETERMINING INITIAL STATE OF NORMAL GAIT 
(INITIAL DIVERGENCE COMPONENT AND THE LIKE) 
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PROVISIONALLY DETERMINE GAIT PARAMETER FOR CURRENT TIME GAIT 
INCLUDING DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



S3028 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETER 
(CORRECT CURRENT TIME GAIT'S PARAMETERS IN SUCH A MANNER THAT 
FINAL DIVERGENCE COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENCE COMPONENT OF NORMAL TURNING GAIT) 



DETERMINE PARAMETERS OF ZMP ALLOWABLE RANGE 
AND FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE FOR FULL-MODEL CORRECTION 



S3030 



SUBROUTINE FOR DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE 



S3032 



DETERMINE ARM SWINGING MOVEMENT FOR CANCELING SPIN FORCE 
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S3036 



DETERMINE INSTANTANEOUS VALUES OF ZMP ALLOWABLE RANGE AND FLOOR REACTION 
FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE FOR FULL-MODEL CORRECTION 



GENERATE CORRECTED GAIT USING FULL MODEL 
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FIG.50 

(PERTURBATION MODEL FOR CORRECTING HORIZONTAL BODY POSITION ) 
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{ PERTURBATION MODEL FOR CORRECTING BODY POSTURE ANGLES } 
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FIG.52 

FLOOR REACTION FORCE'S MOMENT 
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FLOOR REACTION FORCE'S MOMENT 
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FIG.54 

FLOOR REACTION FORCE'S MOMENT 



INCLINATION: h 




FLOOR REACTION FORCE'S 
HORIZONTAL COMPONENT 



BOUNDARY LINE OF 
ALLOWABLE RANGE 
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FIG. 61 
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FIG. 62 
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